static int aon_timer_qmsi_start(struct device *dev) { qm_aonpt_config_t qmsi_cfg; int result = 0; user_cb = NULL; qmsi_cfg.callback = NULL; qmsi_cfg.int_en = false; /* AONPT is a countdown timer. So, set the initial value to * the maximum value. */ qmsi_cfg.count = 0xffffffff; qmsi_cfg.callback_data = NULL; if (IS_ENABLED(CONFIG_AON_API_REENTRANCY)) { k_sem_take(RP_GET(dev), K_FOREVER); } if (qm_aonpt_set_config(QM_AONC_0, &qmsi_cfg)) { result = -EIO; } if (IS_ENABLED(CONFIG_AON_API_REENTRANCY)) { k_sem_give(RP_GET(dev)); } return result; }
static int aon_timer_qmsi_set_alarm(struct device *dev, counter_callback_t callback, u32_t count, void *user_data) { qm_aonpt_config_t qmsi_cfg; int result = 0; /* Check if timer has been started */ if (QM_AONC[QM_AONC_0]->aonpt_cfg == 0) { return -ENOTSUP; } user_cb = callback; qmsi_cfg.callback = aonpt_int_callback; qmsi_cfg.int_en = true; qmsi_cfg.count = count; qmsi_cfg.callback_data = user_data; if (IS_ENABLED(CONFIG_AON_API_REENTRANCY)) { k_sem_take(RP_GET(dev), K_FOREVER); } if (qm_aonpt_set_config(QM_AONC_0, &qmsi_cfg)) { user_cb = NULL; result = -EIO; } if (IS_ENABLED(CONFIG_AON_API_REENTRANCY)) { k_sem_give(RP_GET(dev)); } return result; }
static int rtc_qmsi_set_alarm(struct device *dev, u8_t chan_id, const struct counter_alarm_cfg *alarm_cfg) { qm_rtc_config_t qm_cfg; int result = 0; qm_cfg.init_val = 0; qm_cfg.alarm_en = 1; qm_cfg.alarm_val = alarm_cfg->ticks; user_cb = alarm_cfg->callback; /* Casting callback type due different input parameter from QMSI * compared aganst the Zephyr callback from void cb(struct device *dev) * to void cb(void *) */ qm_cfg.callback = rtc_callback; qm_cfg.callback_data = (void *)alarm_cfg; /* Set prescaler value. Ideally, the divider should come from struct * rtc_config instead. It's safe to use RTC_DIVIDER here for now since * values defined by clk_rtc_div and by QMSI's clk_rtc_div_t match for * both D2000 and SE. */ qm_cfg.prescaler = (clk_rtc_div_t)CONFIG_RTC_PRESCALER - 1; if (IS_ENABLED(CONFIG_RTC_QMSI_API_REENTRANCY)) { k_sem_take(RP_GET(dev), K_FOREVER); } if (qm_rtc_set_config(QM_RTC_0, &qm_cfg)) { result = -EIO; } if (IS_ENABLED(CONFIG_RTC_QMSI_API_REENTRANCY)) { k_sem_give(RP_GET(dev)); } k_busy_wait(60); qm_rtc_set_alarm(QM_RTC_0, alarm_cfg->ticks); return result; }
static int aon_timer_qmsi_stop(struct device *dev) { qm_aonpt_config_t qmsi_cfg; qmsi_cfg.callback = NULL; qmsi_cfg.int_en = false; qmsi_cfg.count = 0; qmsi_cfg.callback_data = NULL; if (IS_ENABLED(CONFIG_AON_API_REENTRANCY)) { k_sem_take(RP_GET(dev), K_FOREVER); } qm_aonpt_set_config(QM_AONC_0, &qmsi_cfg); if (IS_ENABLED(CONFIG_AON_API_REENTRANCY)) { k_sem_give(RP_GET(dev)); } return 0; }
static int aon_timer_init(struct device *dev) { dev->driver_api = &aon_timer_qmsi_api; user_cb = NULL; IRQ_CONNECT(IRQ_GET_NUMBER(QM_IRQ_AONPT_0_INT), CONFIG_AON_TIMER_IRQ_PRI, qm_aonpt_0_isr, NULL, IOAPIC_EDGE | IOAPIC_HIGH); irq_enable(IRQ_GET_NUMBER(QM_IRQ_AONPT_0_INT)); QM_IR_UNMASK_INTERRUPTS(QM_INTERRUPT_ROUTER->aonpt_0_int_mask); if (IS_ENABLED(CONFIG_AON_API_REENTRANCY)) { k_sem_init(RP_GET(dev), 0, UINT_MAX); k_sem_give(RP_GET(dev)); } aonpt_qmsi_set_power_state(dev, DEVICE_PM_ACTIVE_STATE); return 0; }
static int rtc_qmsi_init(struct device *dev) { if (IS_ENABLED(CONFIG_RTC_QMSI_API_REENTRANCY)) { k_sem_init(RP_GET(dev), 1, UINT_MAX); } IRQ_CONNECT(DT_RTC_0_IRQ, CONFIG_RTC_0_IRQ_PRI, qm_rtc_0_isr, NULL, DT_RTC_0_IRQ_FLAGS); /* Unmask RTC interrupt */ irq_enable(DT_RTC_0_IRQ); /* Route RTC interrupt to the current core */ QM_IR_UNMASK_INTERRUPTS(QM_INTERRUPT_ROUTER->rtc_0_int_mask); rtc_qmsi_set_power_state(dev, DEVICE_PM_ACTIVE_STATE); return 0; }