Added overloads for to_string to handle xyz_heading, xyz_location, and xy_location
GetCWPX(), GetCWPY(), GetCWPZ(), GetCWPH() converted to GetCurrentWayPoint