Improved force algorithms

Removed expensive sqrt() function from Vector3 Distance() and
PointCharge Distance().