Added save function of waypoints using the joystick