Changed the timer configuration for Input PWM and Output PWM. FMU now generates correct output. Added ID for mpu60x0 sensors. Added printf statement on succesful completion of PREFLIGHT check