Implemented GPS Way Point Tracking Strategy using VN for position estimate in ENU Coord Frame and Sparkfun for Yaw estimate. The code is integrated and the planner is able to pick up the corresponding target.