static void calibrate_sticks(void)
{
// bug fix: should turn of safety dialog during calibrating, or it might fail when stick is not calibrated and safety setting is on
PAGE_DisableSafetyDialog(1);
PROTOCOL_DeInit();
PAGE_SetModal(1);
PAGE_RemoveAllObjects();
PAGE_SetActionCB(_action_cb_calibrate);
snprintf(tempstring, sizeof(tempstring), "%s", _tr("Center all \nsticks and knobs\nthen press ENT"));
GUI_CreateLabelBox(&guic->msg, 1, 10, LCD_WIDTH -1, LCD_HEIGHT - 10,
LCD_HEIGHT > 70? &NARROW_FONT:&DEFAULT_FONT, NULL, NULL, tempstring);
memcpy(cp->calibration, Transmitter.calibration, sizeof(cp->calibration));
while(1) {
CLOCK_ResetWatchdog();
if(PWR_CheckPowerSwitch())
PWR_Shutdown();
if(priority_ready & (1 << MEDIUM_PRIORITY)) {
BUTTON_Handler();
priority_ready &= ~(1 << MEDIUM_PRIORITY);
}
if(priority_ready & (1 << LOW_PRIORITY)) {
//Only sample every 100msec
GUI_RefreshScreen();
priority_ready = 0;
}
for (u8 i = 0; i < INP_HAS_CALIBRATION; i++) {
s32 value = CHAN_ReadRawInput(i + 1);
if (value > Transmitter.calibration[i].max)
Transmitter.calibration[i].max = value;
else if (value < Transmitter.calibration[i].min)
Transmitter.calibration[i].min = value;
}
if (calibrate_state == CALI_SUCCESSEXIT || calibrate_state == CALI_EXIT)
break;
}
if (calibrate_state == CALI_EXIT)
memcpy(Transmitter.calibration, cp->calibration, sizeof(cp->calibration));
PAGE_SetActionCB(NULL);
PROTOCOL_Init(0);
PAGE_TxConfigureInit(-1); // should be -1 so that devo10 can get back to previous item selection
PAGE_DisableSafetyDialog(0);
}
static void okcancel_cb(guiObject_t *obj, const void *data)
{
(void)obj;
(void)data;
PAGE_TxConfigureInit(0);
}
