/* * Copyright (c) 2015 Intel Corporation. * * SPDX-License-Identifier: Apache-2.0 */ #include #include #include #include #include #include #include #include #include #include "qm_isr.h" #include "qm_rtc.h" static void rtc_callback(void *user_data); static counter_alarm_callback_t user_cb; struct rtc_config { struct counter_config_info info; }; struct rtc_data { #ifdef CONFIG_RTC_QMSI_API_REENTRANCY struct k_sem sem; #endif #ifdef CONFIG_DEVICE_POWER_MANAGEMENT u32_t device_power_state; #endif }; #define RTC_HAS_CONTEXT_DATA \ (CONFIG_RTC_QMSI_API_REENTRANCY || CONFIG_DEVICE_POWER_MANAGEMENT) #if RTC_HAS_CONTEXT_DATA static struct rtc_data rtc_context; #define RTC_CONTEXT (&rtc_context) #else #define RTC_CONTEXT (NULL) #endif /* RTC_HAS_CONTEXT_DATA */ #ifdef CONFIG_RTC_QMSI_API_REENTRANCY #define RP_GET(dev) (&((struct rtc_data *)(dev->driver_data))->sem) #else #define RP_GET(dev) (NULL) #endif #ifdef CONFIG_DEVICE_POWER_MANAGEMENT static void rtc_qmsi_set_power_state(struct device *dev, u32_t power_state) { struct rtc_data *context = dev->driver_data; context->device_power_state = power_state; } static u32_t rtc_qmsi_get_power_state(struct device *dev) { struct rtc_data *context = dev->driver_data; return context->device_power_state; } #else #define rtc_qmsi_set_power_state(...) #endif static int rtc_qmsi_enable(struct device *dev) { clk_periph_enable(CLK_PERIPH_RTC_REGISTER | CLK_PERIPH_CLK); return 0; } static int rtc_qmsi_disable(struct device *dev) { clk_periph_disable(CLK_PERIPH_RTC_REGISTER); return 0; } static int rtc_qmsi_cancel_alarm(struct device *dev, u8_t chan_id) { clk_periph_disable(CLK_PERIPH_RTC_REGISTER); return 0; } static int rtc_qmsi_set_top(struct device *dev, u32_t ticks, counter_top_callback_t callback, void *user_data) { const struct counter_config_info *info = dev->config->config_info; ARG_UNUSED(dev); ARG_UNUSED(callback); ARG_UNUSED(user_data); if (ticks != info->max_top_value) { return -ENOTSUP; } else { return 0; } } 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 u32_t rtc_qmsi_read(struct device *dev) { return QM_RTC[QM_RTC_0]->rtc_ccvr; } static u32_t rtc_qmsi_get_pending_int(struct device *dev) { return QM_RTC[QM_RTC_0]->rtc_stat; } static const struct counter_driver_api api = { .start = rtc_qmsi_enable, .stop = rtc_qmsi_disable, .read = rtc_qmsi_read, .set_top_value = rtc_qmsi_set_top, .set_alarm = rtc_qmsi_set_alarm, .cancel_alarm = rtc_qmsi_cancel_alarm, .get_pending_int = rtc_qmsi_get_pending_int, }; 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; } #ifdef CONFIG_DEVICE_POWER_MANAGEMENT static qm_rtc_context_t rtc_ctx; static int rtc_suspend_device(struct device *dev) { qm_rtc_save_context(QM_RTC_0, &rtc_ctx); rtc_qmsi_set_power_state(dev, DEVICE_PM_SUSPEND_STATE); return 0; } static int rtc_resume_device(struct device *dev) { qm_rtc_restore_context(QM_RTC_0, &rtc_ctx); rtc_qmsi_set_power_state(dev, DEVICE_PM_ACTIVE_STATE); return 0; } /* * Implements the driver control management functionality * the *context may include IN data or/and OUT data */ static int rtc_qmsi_device_ctrl(struct device *dev, u32_t ctrl_command, void *context) { if (ctrl_command == DEVICE_PM_SET_POWER_STATE) { if (*((u32_t *)context) == DEVICE_PM_SUSPEND_STATE) { return rtc_suspend_device(dev); } else if (*((u32_t *)context) == DEVICE_PM_ACTIVE_STATE) { return rtc_resume_device(dev); } } else if (ctrl_command == DEVICE_PM_GET_POWER_STATE) { *((u32_t *)context) = rtc_qmsi_get_power_state(dev); return 0; } return 0; } #endif static const struct rtc_config rtc_conf_info = { .info = { .max_top_value = UINT32_MAX, .freq = 32768, .count_up = true, .channels = 1, } }; DEVICE_DEFINE(rtc, DT_RTC_0_NAME, &rtc_qmsi_init, rtc_qmsi_device_ctrl, RTC_CONTEXT, &rtc_conf_info, POST_KERNEL, CONFIG_KERNEL_INIT_PRIORITY_DEVICE, &api); static void rtc_callback(void *user_data) { const struct counter_alarm_cfg *cfg = user_data; if (user_cb) { (*user_cb)(DEVICE_GET(rtc), 0, cfg->ticks, user_data); } }