uint32_t ssp_drv_set_clk(SSP_ID_Type ssp_id, uint32_t freq)
{
mdev_t *mdev_p;
sspdev_data_t *ssp_data_p;
uint16_t divider;
if (!IS_SSP_PERIPH(ssp_id) || freq <= 0)
return -WM_FAIL;
/* Check ssp_id is initialized */
mdev_p = mdev_get_handle(mdev_ssp_name[ssp_id]);
if (!mdev_p) {
SSP_LOG("Unable to open device %s\r\n",
mdev_ssp_name[ssp_id]);
return -WM_FAIL;
}
ssp_data_p = (sspdev_data_t *) mdev_p->private_data;
/* Calculate Divider */
divider = (uint32_t)(board_cpu_freq()/freq);
ssp_data_p->freq = (uint32_t)((board_cpu_freq() / divider));
if (!IS_SSP_DIVIDER(divider)) {
SSP_LOG("Unable to set %u frequency for %s %d\r\n",
freq, mdev_ssp_name[ssp_id], divider);
ssp_data_p->freq = 0;
return -WM_FAIL;
}
switch (ssp_id) {
case SSP0_ID:
CLK_ModuleClkEnable(CLK_SSP0);
CLK_SSPClkSrc(CLK_SSP_ID_0, CLK_SYSTEM);
CLK_ModuleClkDivider(CLK_SSP0, divider);
break;
case SSP1_ID:
CLK_ModuleClkEnable(CLK_SSP1);
CLK_SSPClkSrc(CLK_SSP_ID_1, CLK_SYSTEM);
CLK_ModuleClkDivider(CLK_SSP1, divider);
break;
case SSP2_ID:
CLK_ModuleClkEnable(CLK_SSP2);
CLK_SSPClkSrc(CLK_SSP_ID_2, CLK_SYSTEM);
CLK_ModuleClkDivider(CLK_SSP2, divider);
break;
}
return ssp_data_p->freq;
}
/*
* Setup the systick timer to generate the tick interrupts at the required
* frequency.
*/
void prvSetupTimerInterrupt( void )
{
/* Configure SysTick to interrupt at the requested rate. */
*(portNVIC_SYSTICK_LOAD) = ( board_cpu_freq() / configTICK_RATE_HZ ) - 1UL;
*(portNVIC_SYSTICK_CTRL) = portNVIC_SYSTICK_CLK | portNVIC_SYSTICK_INT | portNVIC_SYSTICK_ENABLE;
}