Begin Looking at Performance Issues

Caught a few more redundant calculations and removed them. (Mostly
going between lat and i or calculating lat multiple times when not
necessary)