Added I control to PID_Nav, renamed 'halt' to 'hold_point', added update flag for navigation command
Binded I control to navigation, tested on qgroundcontrol, perfect