ArduCopter: only attempt to change settings of optical flow sensor if it has been successfully initialised

This commit is contained in:
rmackay9 2012-12-11 00:14:29 +09:00
parent 628fb1da15
commit b170da34ec

View File

@ -54,7 +54,7 @@ static void init_optflow()
if( optflow.init(false, &timer_scheduler, &spi_semaphore, &spi3_semaphore) == false ) {
g.optflow_enabled = false;
cliSerial->print_P(PSTR("\nFailed to Init OptFlow "));
}
}else{
// suspend timer while we set-up SPI communication
timer_scheduler.suspend_timer();
@ -65,6 +65,7 @@ static void init_optflow()
// resume timer
timer_scheduler.resume_timer();
}
#endif // OPTFLOW == ENABLED
}