//*---------------------------------------------------------------------------- //* DCR function //*---------------------------------------------------------------------------- void CAN_DCR(CAN_INFO drv_info, unsigned int reason, HANDLE param) { CAN_DRIVER_DATA* drv_data; drv_data = drv_info->drv_data; switch(reason) { case DCR_RESET: //Initialize the driver here Task* task; task = usr_task_create_dynamic("CANT", (TASK_FUNCTION) can_thread, 90, CAN_TASK_STACK_SIZE); if (task) { svc_task_schedule(task); task->sp->r0.as_cvoidptr = drv_info; } break; case DCR_OPEN: param->res = RES_OK; break; case DCR_CANCEL: if(param->mode.as_int) { param->svc_list_cancel(drv_data->waiting); } else { param->svc_list_cancel(drv_data->helper); } break; } }
/** DACC Driver DCR routine * * @param drv_info * @param reason * @param param */ void DACC_DCR(DACC_INFO drv_info, unsigned int reason, HANDLE param) { DACC_DRIVER_DATA drv_data = drv_info->drv_data; Dacc* pDacc = drv_info->hw_base; switch(reason) { case DCR_RESET: DACC_off(drv_info); break; case DCR_OPEN: { DRV_DACC_MODE pMode = (DRV_DACC_MODE)(param->mode.as_voidptr); if(drv_data->cnt) { if(pMode->DACC_MR != pDacc->DACC_MR) return; } else { DACC_on(drv_info, pMode); } pDacc->DACC_CHER = pMode->DACC_CHER; drv_data->cnt++; param->res = RES_OK; break; } case DCR_CLOSE: if(!--drv_data->cnt) DACC_off(drv_info); break; case DCR_CANCEL: if (drv_data->pending == param) { pDacc->DACC_PTCR = DACC_PTCR_TXTDIS; drv_data->pending = param->next; if(drv_data->pending) START_TX_HND(pDacc, drv_data->pending); svc_HND_SET_STATUS(param, RES_SIG_IDLE); } else param->svc_list_cancel(drv_data->pending); break; } }
//*---------------------------------------------------------------------------- //* DCR function //*---------------------------------------------------------------------------- void KEY2_DCR(KEY2_DRIVER_INFO* drv_info, unsigned int reason, HANDLE param) { KEY2_DRIVER_DATA* drv_data; drv_data = drv_info->drv_data; switch(reason) { case DCR_RESET: drv_data->key_in = 0; drv_data->key_out = 0; usr_task_init_static(&keyboard_task_desc, true); keyboard_task.sp->r0.as_cvoidptr = drv_info; break; case DCR_OPEN: param->res = RES_OK; break; case DCR_CANCEL: param->svc_list_cancel(drv_data->waiting); break; case DCR_PARAMS: //keycode sent from thread { HANDLE hnd = drv_data->waiting; if( hnd ) { // send the code to the waiting *hnd->dst.as_byteptr++ = (unsigned int)param; drv_data->waiting = hnd->next; svc_HND_SET_STATUS(hnd, RES_SIG_OK); } else { // store the code in the key_buf drv_data->key_buf[drv_data->key_in] = (unsigned int)param; drv_data->key_in = (drv_data->key_in+1) & DRV_KEYBUF_SIZE; } } break; } }
/** USART DCR * * @param drv_info * @param reason * @param param */ void USART_DCR(USART_INFO drv_info, unsigned int reason, HANDLE param) { UART_DRIVER_DATA drv_data = drv_info->drv_data; unsigned int temp; switch(reason) { case DCR_RESET: drv_data->buf_size = drv_info->buf_size; USART_OFF(drv_info); break; case DCR_OPEN: { DRV_UART_MODE pMode = (DRV_UART_MODE)(param->mode.as_voidptr); if(pMode) { if(drv_data->cnt) { if( (pMode->mode != drv_data->mode) || (pMode->baudrate != drv_data->baudrate)) return; } else { drv_data->mode = pMode->mode; drv_data->baudrate =pMode->baudrate; USART_CFG(drv_info, pMode); START_RX_BUF(drv_info->hw_base, drv_data); } drv_data->cnt++; param->res = RES_OK; } break; } case DCR_CLOSE: if(drv_data->cnt) if(!--drv_data->cnt) USART_OFF(drv_info); break; case DCR_CANCEL: { if (param->cmd & FLAG_READ) { if(param == drv_data->hnd_rcv) { STOP_RX(drv_info->hw_base); temp = drv_info->hw_base->US_RCR; if(param->len > temp) { param->len = temp; param->dst.as_int = drv_info->hw_base->US_RPR; temp = RES_OK; } else temp = RES_SIG_IDLE; drv_data->hnd_rcv = param->next; if( drv_data->hnd_rcv ) START_RX_HND(drv_info->hw_base, drv_data, drv_data->hnd_rcv); else START_RX_BUF(drv_info->hw_base, drv_data); svc_HND_SET_STATUS(param, temp); } else param->svc_list_cancel(drv_data->hnd_rcv); } else { if(param == drv_data->hnd_snd) { STOP_TX(drv_info->hw_base); temp = drv_info->hw_base->US_TCR; if(param->len > temp) { param->len = temp; param->src.as_int = drv_info->hw_base->US_TPR; temp = RES_OK; } else temp = RES_SIG_IDLE; drv_data->hnd_snd = param->next; if( drv_data->hnd_snd ) START_TX_HND(drv_info->hw_base, drv_data->hnd_snd); svc_HND_SET_STATUS(param, temp); } else param->svc_list_cancel(drv_data->hnd_snd); } break; } case DCR_CLOCK: if(drv_data->cnt) drv_info->hw_base->US_BRGR = AT91_GetDiv(drv_data->baudrate); break; } }
void dcr_SerialDriver(UART_DRIVER_INFO* drv_info, unsigned int reason, HANDLE hnd) { UART_Type * Uart = drv_info->hw_base; UART_DRIVER_DATA *drv_data = drv_info->drv_data; switch(reason) { case DCR_ISR: TX_CTS(drv_data, Uart, (unsigned int)hnd); return; case DCR_RESET: SysCtlPeripheralReset(drv_info->info.peripheral_indx); SysCtlPeripheralDisable(drv_info->info.peripheral_indx); // ??? turn off return; case DCR_OPEN: { UART_DRIVER_MODE *uart_mode = (UART_DRIVER_MODE *)(hnd->mode.as_voidptr); if(uart_mode) { //unsigned long mode, baudrate; if(drv_data->cnt) { if( uart_mode->mode != drv_data->mode.mode || uart_mode->baudrate != drv_data->mode.baudrate || uart_mode->hw_flow != drv_data->mode.hw_flow ) { return; } } else { // Enable AND Reset the UART peripheral SysCtlPeripheralReset(drv_info->info.peripheral_indx); if(drv_data->mode.hw_flow) { PIO_Cfg_List((PIN_DESC *)&drv_info->uart_pins[UART_LIST_ALL_PINS]); ConfigureUart(drv_info, drv_data, uart_mode); #ifdef HW_VER_10 if(drv_info->info.drv_index != UART1_IRQn) TX_CTS(drv_data, Uart, PIO_Read(drv_info->uart_pins[CTS_PIN])); #endif } else { PIO_Cfg_List((PIN_DESC *)&drv_info->uart_pins[UART_LIST_RX_TX_PINS]); ConfigureUart(drv_info, drv_data, uart_mode); } START_RX_BUF(Uart, drv_info, drv_data); } drv_data->cnt++; hnd->res = RES_OK; } return; } case DCR_CLOSE: if(drv_data->cnt) drv_data->cnt--; case DCR_CANCEL: { if( !(hnd->res & FLG_BUSY)) return; if (hnd->cmd & FLAG_READ) { if(hnd == drv_data->hnd_rcv) { STOP_RX(Uart); if(hnd->len > drv_data->rx_remaining || hnd->mode0 ) { hnd->len = drv_data->rx_remaining; hnd->res = RES_SIG_OK; } else hnd->res = RES_SIG_IDLE; drv_data->hnd_rcv = hnd->next; svc_HND_SET_STATUS(hnd, hnd->res); if( (hnd=drv_data->hnd_rcv) ) START_RX_HND(Uart, drv_info, hnd); else START_RX_BUF(Uart, drv_info, drv_data); } else { // try cnacel hnd->svc_list_cancel(drv_data->hnd_rcv); } } else { if(hnd == drv_data->hnd_snd) { STOP_TX(Uart); drv_data->hnd_snd = hnd->next; svc_HND_SET_STATUS(hnd, RES_SIG_IDLE); if( (hnd=drv_data->hnd_snd) ) START_TX_HND(Uart, hnd); } else { hnd->svc_list_cancel(drv_data->hnd_snd); } } if(!drv_data->cnt) { NVIC->NVIC_DisableIRQ(drv_info->info.drv_index); Uart->UARTDisable(); STOP_RX(Uart); STOP_TX(Uart); SysCtlPeripheralDisable(drv_info->info.peripheral_indx); SYSCTL->SysCtlPeripheralDeepSleepDisable(drv_info->info.peripheral_indx); SYSCTL->SysCtlPeripheralSleepDisable(drv_info->info.peripheral_indx); if(drv_data->mode.hw_flow) PIO_Free_List((PIN_DESC *)&drv_info->uart_pins[UART_LIST_ALL_PINS]); else PIO_Free_List((PIN_DESC *)&drv_info->uart_pins[UART_LIST_RX_TX_PINS]); } return; } case DCR_CLOCK: return; } }