static int allocate_divider(I2cDividerType divider) { I2cDividerInfo *p_div = &i2c_dividers[divider]; if (p_div->div_num == CY_INVALID_DIVIDER) { p_div->div_num = cy_clk_allocate_divider(CY_SYSCLK_DIV_8_BIT); if (p_div->div_num != CY_INVALID_DIVIDER) { p_div->div_type = CY_SYSCLK_DIV_8_BIT; } else { p_div->div_num = cy_clk_allocate_divider(CY_SYSCLK_DIV_16_BIT); if (p_div->div_num != CY_INVALID_DIVIDER) { p_div->div_type = CY_SYSCLK_DIV_16_BIT; } } } if (p_div->div_num != CY_INVALID_DIVIDER) { // Set up proper frequency; uint32_t div_value = cy_PeriClkFreqHz / p_div->clk_frequency; p_div->clk_frequency = cy_PeriClkFreqHz / div_value; if (Cy_SysClk_PeriphSetDivider(p_div->div_type, p_div->div_num, div_value) == CY_SYSCLK_SUCCESS) { Cy_SysClk_PeriphEnableDivider(p_div->div_type, p_div->div_num); } else { p_div->div_num = CY_INVALID_DIVIDER; } } return (p_div->div_num == CY_INVALID_DIVIDER) ? -1 : 0; }
static int allocate_divider(spi_obj_t *obj) { if (obj->div_num == CY_INVALID_DIVIDER) { obj->div_type = CY_SYSCLK_DIV_16_BIT; obj->div_num = cy_clk_allocate_divider(CY_SYSCLK_DIV_16_BIT); } return (obj->div_num == CY_INVALID_DIVIDER)? -1 : 0; }
void pwmout_init(pwmout_t *obj, PinName pin) { uint32_t pwm_cnt = 0; uint32_t pwm_function = 0; uint32_t abs_cnt_num = 0; MBED_ASSERT(obj); MBED_ASSERT(pin != (PinName)NC); // Allocate and setup clock. if (pwm_clock_divider == CY_INVALID_DIVIDER) { pwm_clock_divider = cy_clk_allocate_divider(CY_SYSCLK_DIV_8_BIT); if (pwm_clock_divider == CY_INVALID_DIVIDER) { error("PWM clock divider allocation failed."); return; } Cy_SysClk_PeriphSetDivider(CY_SYSCLK_DIV_8_BIT, pwm_clock_divider, (CY_CLK_PERICLK_FREQ_HZ / PWMOUT_BASE_CLOCK_HZ) - 1); Cy_SysClk_PeriphEnableDivider(CY_SYSCLK_DIV_8_BIT, pwm_clock_divider); } pwm_cnt = pinmap_peripheral(pin, PinMap_PWM_OUT); if (pwm_cnt != (uint32_t)NC) { if (cy_reserve_io_pin(pin)) { error("PWMOUT pin reservation conflict."); } obj->base = (TCPWM_Type*)CY_PERIPHERAL_BASE(pwm_cnt); obj->pin = pin; if (obj->base == TCPWM0) { obj->counter_id = ((PWMName)pwm_cnt - PWM_32b_0) / (PWM_32b_1 - PWM_32b_0); abs_cnt_num = obj->counter_id; } else { // TCPWM1 is used. obj->counter_id = ((PWMName)pwm_cnt - PWM_16b_0) / (PWM_16b_1 - PWM_16b_0); abs_cnt_num = obj->counter_id + 8; } if (cy_reserve_tcpwm(abs_cnt_num)) { error("PWMOUT Timer/Counter reservation conflict."); } // Configure clock. pwm_function = pinmap_function(pin, PinMap_PWM_OUT); obj->clock = CY_PIN_CLOCK(pwm_function); Cy_SysClk_PeriphAssignDivider(obj->clock, CY_SYSCLK_DIV_8_BIT, pwm_clock_divider); Cy_TCPWM_PWM_Init(obj->base, obj->counter_id, &pwm_config); pin_function(pin, pwm_function); // These will be properly configured later on. obj->period = 0; obj->pulse_width = 0; obj->prescaler = 0; #if DEVICE_SLEEP && DEVICE_LPTICKER obj->pm_callback_handler.callback = pwm_pm_callback; obj->pm_callback_handler.type = CY_SYSPM_DEEPSLEEP; obj->pm_callback_handler.skipMode = 0; obj->pm_callback_handler.callbackParams = &obj->pm_callback_params; obj->pm_callback_params.base = obj->base; obj->pm_callback_params.context = obj; if (!Cy_SysPm_RegisterCallback(&obj->pm_callback_handler)) { error("PM callback registration failed!"); } #endif // DEVICE_SLEEP && DEVICE_LPTICKER } else { error("PWM OUT pinout mismatch."); } }