/**
* USART DSR
* @param drv_info
* @param hnd
*/
void USART_DSR(USART_INFO drv_info, HANDLE hnd)
{
UART_DRIVER_DATA drv_data = drv_info->drv_data;
unsigned char *ptr;
signed int size;
if(hnd->len)
{
hnd->next = NULL;
if (hnd->cmd & FLAG_READ)
{
if(drv_data->hnd_rcv)
{
hnd->list_add(drv_data->hnd_rcv);
return;
}
STOP_RX(drv_info->hw_base);
//try to read from buffer
ptr = (unsigned char*) (drv_info->hw_base->US_RPR);
if (ptr != drv_data->rx_ptr)
{
if (ptr < drv_data->rx_ptr)
{
size = min(hnd->len, drv_info->buf_size -
(drv_data->rx_ptr - drv_data->rx_buf));
memcpy(hnd->dst.as_byteptr, drv_data->rx_ptr, size);
hnd->len -= size;
hnd->dst.as_int += size;
drv_data->rx_ptr += size;
if(drv_data->rx_ptr == &drv_data->rx_buf[drv_info->buf_size])
drv_data->rx_ptr = drv_data->rx_buf;
}
if (hnd->len && (ptr > drv_data->rx_ptr))
{
size =min(hnd->len, ptr - drv_data->rx_ptr);
memcpy(hnd->dst.as_byteptr, drv_data->rx_ptr, size);
hnd->len -= size;
hnd->dst.as_int += size;
drv_data->rx_ptr += size;
}
}
if (hnd->len )
{
//receive directly
drv_data->hnd_rcv = hnd;
START_RX_HND(drv_info->hw_base, drv_data, hnd);
} else
{
RESUME_RX(drv_info->hw_base);
svc_HND_SET_STATUS(hnd, RES_SIG_OK);
}
} else
{
if (hnd->cmd & FLAG_WRITE)
{
if(drv_data->hnd_snd)
{
hnd->list_add(drv_data->hnd_snd);
} else
{
drv_data->hnd_snd = hnd;
START_TX_HND(drv_info->hw_base, hnd);
}
} else
{
svc_HND_SET_STATUS(hnd, RES_SIG_ERROR);
}
}
} else
{
svc_HND_SET_STATUS(hnd, RES_SIG_IDLE);
}
}
void dsr_SerialDriver(UART_DRIVER_INFO* drv_info, HANDLE hnd)
{
unsigned char *ptr;
signed int size;
UART_DRIVER_DATA *drv_data = drv_info->drv_data;
UART_Type * Uart = drv_info->hw_base;
hnd->next = NULL;
if (hnd->cmd & FLAG_READ)
{
hnd->mode0 = 0; // няма нищо прието в хендъла
if(drv_data->hnd_rcv)
{
hnd->list_add(drv_data->hnd_rcv);
return;
}
STOP_RX(Uart);
//try to read from buffer
ptr = drv_data->rx_wrptr;
if( hnd->len && (ptr!= drv_data->rx_ptr) )
{
if(ptr < drv_data->rx_ptr)
{
size =min(hnd->len, (unsigned int)(&drv_data->rx_buf[RX_BUF_SIZE]) - (unsigned int)drv_data->rx_ptr);
memcpy(hnd->dst.as_byteptr, drv_data->rx_ptr, size);
hnd->mode0 = 1; // в хендъла е писано
hnd->len -= size;
hnd->dst.as_int += size;
drv_data->rx_ptr += size;
if(drv_data->rx_ptr == &drv_data->rx_buf[RX_BUF_SIZE])
drv_data->rx_ptr = drv_data->rx_buf;
}
if( hnd->len && (ptr!= drv_data->rx_ptr) )
{
size =min(hnd->len, ptr - drv_data->rx_ptr);
hnd->mode0 = 1; // в хендъла е писано
memcpy(hnd->dst.as_byteptr, drv_data->rx_ptr, size);
hnd->len -= size;
hnd->dst.as_int += size;
drv_data->rx_ptr += size;
}
}
if (hnd->len == 0)
{
RESUME_RX(Uart);
svc_HND_SET_STATUS(hnd, RES_SIG_OK);
return;
}
//receive directly
hnd->res = RES_BUSY;
drv_data->hnd_rcv = hnd;
START_RX_HND(Uart, drv_info, hnd);
return;
}
if (hnd->cmd & FLAG_WRITE)
{
if(hnd->len)
{
if(drv_data->hnd_snd)
{
hnd->list_add(drv_data->hnd_snd);
return;
}
hnd->res = RES_BUSY;
drv_data->hnd_snd = hnd;
START_TX_HND(Uart, hnd);
}
else
svc_HND_SET_STATUS(hnd, RES_SIG_OK);
return;
}
svc_HND_SET_STATUS(hnd, RES_SIG_ERROR);
}
