INS: add support for 400hz for PX4
Copter: run main loop at 400hz for pixhawk