modify codes for fractional divider

This commit is contained in:
reynoldxu 2013-07-24 18:31:26 +08:00
parent 9980041de6
commit a927b48049
1 changed files with 10 additions and 3 deletions

View File

@ -39,19 +39,25 @@ static struct k60_serial_device _k60_node =
static rt_err_t _configure(struct rt_serial_device *serial, struct serial_configure *cfg) static rt_err_t _configure(struct rt_serial_device *serial, struct serial_configure *cfg)
{ {
unsigned int reg_C1 = 0,reg_BDH = 0,reg_BDL = 0,reg_S2; unsigned int reg_C1 = 0,reg_C4 = 0,reg_BDH = 0,reg_BDL = 0,reg_S2,reg_BRFA=0;
unsigned int cal_SBR = 0; unsigned int cal_SBR = 0;
UART_Type *uart_reg; UART_Type *uart_reg;
/* ref : drivers\system_MK60F12.c Line 64 ,BusClock = 60MHz */
uart_reg = ((struct k60_serial_device *)serial->parent.user_data)->baseAddress; uart_reg = ((struct k60_serial_device *)serial->parent.user_data)->baseAddress;
//calc SBR
cal_SBR = 60000000 / (16 * cfg->baud_rate); cal_SBR = 60000000 / (16 * cfg->baud_rate);
reg_BDH = (cal_SBR & 0x1FFF) >> 8 & 0x00FF;
reg_BDL = cal_SBR & 0x00FF;
//calc baud_rate //calc baud_rate
reg_BDH = (cal_SBR & 0x1FFF) >> 8 & 0x00FF; reg_BDH = (cal_SBR & 0x1FFF) >> 8 & 0x00FF;
reg_BDL = cal_SBR & 0x00FF; reg_BDL = cal_SBR & 0x00FF;
//fractional divider
reg_BRFA = ((60000*32000)/(cfg->baud_rate * 16)) - (cal_SBR * 32);
reg_C4 = (unsigned char)(reg_BRFA & 0x001F);
//calc bit_order //calc bit_order
if (cfg->bit_order == BIT_ORDER_LSB) if (cfg->bit_order == BIT_ORDER_LSB)
reg_S2 &= ~(UART_S2_MSBF_MASK<<UART_S2_MSBF_SHIFT); reg_S2 &= ~(UART_S2_MSBF_MASK<<UART_S2_MSBF_SHIFT);
@ -96,6 +102,7 @@ static rt_err_t _configure(struct rt_serial_device *serial, struct serial_config
uart_reg->BDH = reg_BDH; uart_reg->BDH = reg_BDH;
uart_reg->BDL = reg_BDL; uart_reg->BDL = reg_BDL;
uart_reg->C1 = reg_C1; uart_reg->C1 = reg_C1;
uart_reg->C4 = reg_C4;
uart_reg->S2 = reg_S2; uart_reg->S2 = reg_S2;
uart_reg->S2 = 0; uart_reg->S2 = 0;