Added scalar param to generateWaypoint
Tested motionVectorToWaypoint
Added destructor to plane object
Changed map and forcefield to non pointer members, no map in plane
insert