[PathPlanner]: 1) Fixed altitude bug in waypoint model
2) Ensured that longitude/east updates when north/latitude is changed.