103 lines
2.7 KiB
C
103 lines
2.7 KiB
C
/*
|
|
* Copyright (c) 2017, NXP
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#define DT_DRV_COMPAT nxp_kinetis_sim
|
|
#include <errno.h>
|
|
#include <soc.h>
|
|
#include <drivers/clock_control.h>
|
|
#include <dt-bindings/clock/kinetis_sim.h>
|
|
#include <fsl_clock.h>
|
|
|
|
#define LOG_LEVEL CONFIG_CLOCK_CONTROL_LOG_LEVEL
|
|
#include <logging/log.h>
|
|
LOG_MODULE_REGISTER(clock_control);
|
|
|
|
static int mcux_sim_on(struct device *dev, clock_control_subsys_t sub_system)
|
|
{
|
|
clock_ip_name_t clock_ip_name = (clock_ip_name_t) sub_system;
|
|
|
|
CLOCK_EnableClock(clock_ip_name);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int mcux_sim_off(struct device *dev, clock_control_subsys_t sub_system)
|
|
{
|
|
clock_ip_name_t clock_ip_name = (clock_ip_name_t) sub_system;
|
|
|
|
CLOCK_DisableClock(clock_ip_name);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int mcux_sim_get_subsys_rate(struct device *dev,
|
|
clock_control_subsys_t sub_system,
|
|
u32_t *rate)
|
|
{
|
|
clock_name_t clock_name;
|
|
|
|
switch ((u32_t) sub_system) {
|
|
case KINETIS_SIM_LPO_CLK:
|
|
clock_name = kCLOCK_LpoClk;
|
|
break;
|
|
default:
|
|
clock_name = (clock_name_t) sub_system;
|
|
break;
|
|
}
|
|
|
|
*rate = CLOCK_GetFreq(clock_name);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#if DT_HAS_NODE(DT_INST(0, nxp_kinetis_ke1xf_sim))
|
|
#define NXP_KINETIS_SIM_LABEL DT_LABEL(DT_INST(0, nxp_kinetis_ke1xf_sim))
|
|
#if DT_NODE_HAS_PROP(DT_INST(0, nxp_kinetis_ke1xf_sim), clkout_source)
|
|
#define NXP_KINETIS_SIM_CLKOUT_SOURCE \
|
|
DT_PROP(DT_INST(0, nxp_kinetis_ke1xf_sim), clkout_source)
|
|
#endif
|
|
#if DT_NODE_HAS_PROP(DT_INST(0, nxp_kinetis_ke1xf_sim), clkout_divider)
|
|
#define NXP_KINETIS_SIM_CLKOUT_DIVIDER \
|
|
DT_PROP(DT_INST(0, nxp_kinetis_ke1xf_sim), clkout_divider)
|
|
#endif
|
|
#else
|
|
#define NXP_KINETIS_SIM_LABEL DT_LABEL(DT_INST(0, nxp_kinetis_sim))
|
|
#if DT_NODE_HAS_PROP(DT_INST(0, nxp_kinetis_sim), clkout_source)
|
|
#define NXP_KINETIS_SIM_CLKOUT_SOURCE \
|
|
DT_PROP(DT_INST(0, nxp_kinetis_sim), clkout_source)
|
|
#endif
|
|
#if DT_NODE_HAS_PROP(DT_INST(0, nxp_kinetis_sim), clkout_divider)
|
|
#define NXP_KINETIS_SIM_CLKOUT_DIVIDER \
|
|
DT_PROP(DT_INST(0, nxp_kinetis_sim), clkout_divider)
|
|
#endif
|
|
#endif
|
|
|
|
static int mcux_sim_init(struct device *dev)
|
|
{
|
|
#ifdef NXP_KINETIS_SIM_CLKOUT_DIVIDER
|
|
SIM->CHIPCTL = (SIM->CHIPCTL & ~SIM_CHIPCTL_CLKOUTDIV_MASK)
|
|
| SIM_CHIPCTL_CLKOUTDIV(NXP_KINETIS_SIM_CLKOUT_DIVIDER);
|
|
#endif
|
|
#ifdef NXP_KINETIS_SIM_CLKOUT_SOURCE
|
|
SIM->CHIPCTL = (SIM->CHIPCTL & ~SIM_CHIPCTL_CLKOUTSEL_MASK)
|
|
| SIM_CHIPCTL_CLKOUTSEL(NXP_KINETIS_SIM_CLKOUT_SOURCE);
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct clock_control_driver_api mcux_sim_driver_api = {
|
|
.on = mcux_sim_on,
|
|
.off = mcux_sim_off,
|
|
.get_rate = mcux_sim_get_subsys_rate,
|
|
};
|
|
|
|
DEVICE_AND_API_INIT(mcux_sim, NXP_KINETIS_SIM_LABEL,
|
|
&mcux_sim_init,
|
|
NULL, NULL,
|
|
PRE_KERNEL_1, CONFIG_KERNEL_INIT_PRIORITY_DEVICE,
|
|
&mcux_sim_driver_api);
|