Added andrew_Fsquared_test and ForceShape_test to tests
Fixed test errors and removed dependency on pointers
Test that checks whether or not a set of points is in a field
Commented out some ROS_INFO debug lines