GPS_Glitch: add check_position method
InertialNav: integrate GPS_Glitch's check_position
Copter: integrate GPS_Glitch's check_position