//=====[ Control Loop ]=========================================================
void controlSetup(void) {
// Init list of synchronous timers
LIST_INIT(&timers_lst);
// Schedule SMS handling task
GSM(gsmSMSDelRead());
timer_setDelay(&sms_tmr, ms_to_ticks(SMS_CHECK_SEC*1000));
timer_setSoftint(&sms_tmr, sms_task, (iptr_t)&sms_tmr);
synctimer_add(&sms_tmr, &timers_lst);
// Schedule Console handling task
timer_setDelay(&cmd_tmr, ms_to_ticks(CMD_CHECK_SEC*1000));
timer_setSoftint(&cmd_tmr, cmd_task, (iptr_t)&cmd_tmr);
synctimer_add(&cmd_tmr, &timers_lst);
// Setup Button handling task
timer_setDelay(&btn_tmr, ms_to_ticks(BTN_CHECK_SEC*1000));
timer_setSoftint(&btn_tmr, btn_task, (iptr_t)&btn_tmr);
// Setup console RX timeout
console_init(&dbg_port.fd);
ser_settimeouts(&dbg_port, 0, 1000);
// Dump ADE7753 configuration
meter_ade7753_dumpConf();
// Get bitmask of enabled channels
chEnabled = ee_getEnabledChMask();
// Get bitmask of enabled channels
chCritical = ee_getCriticalChMask();
// Enabling calibration only for enabled channels
chCalib = chEnabled;
// Setup channels calibration data
for (uint8_t ch=0; ch<16; ch++)
loadCalibrationData(ch);
// Update signal level
GSM(updateCSQ());
// Setup Re-Calibration Weeks
resetCalibrationCountdown();
// Enabling the watchdog for the control loop
WATCHDOG_ENABLE();
// Initi the analog MUX to current channel
switchAnalogMux(curCh);
}
static void synctimer_test(void)
{
size_t i;
LIST_INIT(&synctimer_list);
for (i = 0; i < countof(synctimer_timers); ++i)
{
Timer *timer = &synctimer_timers[i];
timer_setDelay(timer, ms_to_ticks(test_delays[i]));
timer_setSoftint(timer, synctimer_test_hook, (iptr_t)timer);
synctimer_add(timer, &synctimer_list);
}
int secs = 0;
mtime_t start_time = ticks_to_ms(timer_clock());
mtime_t now;
while (secs <= 10)
{
now = ticks_to_ms(timer_clock());
synctimer_poll(&synctimer_list);
if (now - start_time >= 1000)
{
++secs;
start_time += 1000;
kprintf("seconds = %d, ticks=%lu\n", secs, (unsigned long)now);
}
wdt_reset();
}
for (i = 0; i < countof(synctimer_timers); ++i)
{
synctimer_abort(&synctimer_timers[i]);
}
}
static void timer_test_async(void)
{
size_t i;
for (i = 0; i < countof(test_timers); ++i)
{
Timer *timer = &test_timers[i];
timer_setDelay(timer, ms_to_ticks(test_delays[i]));
timer_setSoftint(timer, timer_test_hook, (iptr_t)timer);
timer_add(timer);
}
}