re-format the coding style in serial.c
1, Tabs to Spaces 2, File Format(CR/LF) using UNIX style 3, maximum line length = 80 git-svn-id: https://rt-thread.googlecode.com/svn/trunk@2281 bbd45198-f89e-11dd-88c7-29a3b14d5316
This commit is contained in:
dzzxzz@gmail.com
parent
095b0ae5c0
commit
e699e09a11
|
|
@ -1,364 +1,379 @@
|
|||
/*
|
||||
* File : serial.c
|
||||
* This file is part of RT-Thread RTOS
|
||||
* COPYRIGHT (C) 2006 - 2012, RT-Thread Development Team
|
||||
*
|
||||
* The license and distribution terms for this file may be
|
||||
* found in the file LICENSE in this distribution or at
|
||||
* http://www.rt-thread.org/license/LICENSE
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2006-03-13 bernard first version
|
||||
* 2012-05-15 lgnq modified according bernard's implementation.
|
||||
* 2012-05-28 bernard code cleanup
|
||||
*/
|
||||
|
||||
#include <rthw.h>
|
||||
#include <rtthread.h>
|
||||
#include <rtdevice.h>
|
||||
|
||||
rt_inline void serial_ringbuffer_init(struct serial_ringbuffer *rbuffer)
|
||||
{
|
||||
rt_memset(rbuffer->buffer, 0, sizeof(rbuffer->buffer));
|
||||
rbuffer->put_index = 0;
|
||||
rbuffer->get_index = 0;
|
||||
}
|
||||
|
||||
rt_inline void serial_ringbuffer_putc(struct serial_ringbuffer *rbuffer, char ch)
|
||||
{
|
||||
rt_base_t level;
|
||||
|
||||
/* disable interrupt */
|
||||
level = rt_hw_interrupt_disable();
|
||||
|
||||
rbuffer->buffer[rbuffer->put_index] = ch;
|
||||
rbuffer->put_index = (rbuffer->put_index + 1) & (SERIAL_RBUFFER_SIZE - 1);
|
||||
|
||||
/* if the next position is read index, discard this 'read char' */
|
||||
if (rbuffer->put_index == rbuffer->get_index)
|
||||
{
|
||||
rbuffer->get_index = (rbuffer->get_index + 1) & (SERIAL_RBUFFER_SIZE - 1);
|
||||
}
|
||||
|
||||
/* enable interrupt */
|
||||
rt_hw_interrupt_enable(level);
|
||||
}
|
||||
|
||||
rt_inline int serial_ringbuffer_putchar(struct serial_ringbuffer *rbuffer, char ch)
|
||||
{
|
||||
rt_base_t level;
|
||||
rt_uint16_t next_index;
|
||||
|
||||
/* disable interrupt */
|
||||
level = rt_hw_interrupt_disable();
|
||||
|
||||
next_index = (rbuffer->put_index + 1) & (SERIAL_RBUFFER_SIZE - 1);
|
||||
if (next_index != rbuffer->get_index)
|
||||
{
|
||||
rbuffer->buffer[rbuffer->put_index] = ch;
|
||||
rbuffer->put_index = next_index;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* enable interrupt */
|
||||
rt_hw_interrupt_enable(level);
|
||||
return -1;
|
||||
}
|
||||
|
||||
/* enable interrupt */
|
||||
rt_hw_interrupt_enable(level);
|
||||
return 1;
|
||||
}
|
||||
|
||||
rt_inline int serial_ringbuffer_getc(struct serial_ringbuffer *rbuffer)
|
||||
{
|
||||
int ch;
|
||||
rt_base_t level;
|
||||
|
||||
ch = -1;
|
||||
/* disable interrupt */
|
||||
level = rt_hw_interrupt_disable();
|
||||
if (rbuffer->get_index != rbuffer->put_index)
|
||||
{
|
||||
ch = rbuffer->buffer[rbuffer->get_index];
|
||||
rbuffer->get_index = (rbuffer->get_index + 1) & (SERIAL_RBUFFER_SIZE - 1);
|
||||
}
|
||||
/* enable interrupt */
|
||||
rt_hw_interrupt_enable(level);
|
||||
return ch;
|
||||
}
|
||||
|
||||
rt_inline rt_uint32_t serial_ringbuffer_size(struct serial_ringbuffer *rbuffer)
|
||||
{
|
||||
rt_uint32_t size;
|
||||
rt_base_t level;
|
||||
|
||||
level = rt_hw_interrupt_disable();
|
||||
size = (rbuffer->put_index - rbuffer->get_index) & (SERIAL_RBUFFER_SIZE - 1);
|
||||
rt_hw_interrupt_enable(level);
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
/* RT-Thread Device Interface */
|
||||
|
||||
/*
|
||||
* This function initializes serial
|
||||
*/
|
||||
static rt_err_t rt_serial_init(struct rt_device *dev)
|
||||
{
|
||||
rt_err_t result = RT_EOK;
|
||||
struct rt_serial_device *serial;
|
||||
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
serial = (struct rt_serial_device *)dev;
|
||||
|
||||
if (!(dev->flag & RT_DEVICE_FLAG_ACTIVATED))
|
||||
{
|
||||
/* apply configuration */
|
||||
if (serial->ops->configure)
|
||||
result = serial->ops->configure(serial, &serial->config);
|
||||
|
||||
if (result != RT_EOK)
|
||||
return result;
|
||||
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_RX)
|
||||
serial_ringbuffer_init(serial->int_rx);
|
||||
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_TX)
|
||||
serial_ringbuffer_init(serial->int_tx);
|
||||
|
||||
/* set activated */
|
||||
dev->flag |= RT_DEVICE_FLAG_ACTIVATED;
|
||||
}
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
static rt_err_t rt_serial_open(struct rt_device *dev, rt_uint16_t oflag)
|
||||
{
|
||||
struct rt_serial_device *serial;
|
||||
rt_uint32_t int_flags = 0;
|
||||
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
serial = (struct rt_serial_device *)dev;
|
||||
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_RX)
|
||||
int_flags = RT_SERIAL_RX_INT;
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_TX)
|
||||
int_flags |= RT_SERIAL_TX_INT;
|
||||
|
||||
if (int_flags)
|
||||
{
|
||||
serial->ops->control(serial, RT_DEVICE_CTRL_SET_INT, (void *)int_flags);
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t rt_serial_close(struct rt_device *dev)
|
||||
{
|
||||
struct rt_serial_device *serial;
|
||||
rt_uint32_t int_flags = 0;
|
||||
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
serial = (struct rt_serial_device *)dev;
|
||||
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_RX)
|
||||
int_flags = RT_SERIAL_RX_INT;
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_TX)
|
||||
int_flags |= RT_SERIAL_TX_INT;
|
||||
|
||||
if (int_flags)
|
||||
{
|
||||
serial->ops->control(serial, RT_DEVICE_CTRL_CLR_INT, (void *)int_flags);
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_size_t rt_serial_read(struct rt_device *dev, rt_off_t pos, void *buffer, rt_size_t size)
|
||||
{
|
||||
rt_uint8_t *ptr;
|
||||
rt_uint32_t read_nbytes;
|
||||
struct rt_serial_device *serial;
|
||||
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
serial = (struct rt_serial_device *)dev;
|
||||
|
||||
ptr = (rt_uint8_t *)buffer;
|
||||
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_RX)
|
||||
{
|
||||
/* interrupt mode Rx */
|
||||
while (size)
|
||||
{
|
||||
int ch;
|
||||
|
||||
ch = serial_ringbuffer_getc(serial->int_rx);
|
||||
if (ch == -1)
|
||||
break;
|
||||
|
||||
*ptr = ch & 0xff;
|
||||
ptr ++;
|
||||
size --;
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
/* polling mode */
|
||||
while ((rt_uint32_t)ptr - (rt_uint32_t)buffer < size)
|
||||
{
|
||||
*ptr = serial->ops->getc(serial);
|
||||
ptr ++;
|
||||
}
|
||||
}
|
||||
|
||||
read_nbytes = (rt_uint32_t)ptr - (rt_uint32_t)buffer;
|
||||
/* set error code */
|
||||
if (read_nbytes == 0)
|
||||
{
|
||||
rt_set_errno(-RT_EEMPTY);
|
||||
}
|
||||
|
||||
return read_nbytes;
|
||||
}
|
||||
|
||||
static rt_size_t rt_serial_write(struct rt_device *dev, rt_off_t pos,
|
||||
const void *buffer, rt_size_t size)
|
||||
{
|
||||
rt_uint8_t *ptr;
|
||||
rt_size_t write_nbytes = 0;
|
||||
struct rt_serial_device *serial;
|
||||
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
serial = (struct rt_serial_device *)dev;
|
||||
|
||||
ptr = (rt_uint8_t*)buffer;
|
||||
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_TX)
|
||||
{
|
||||
/* warning: data will be discarded if buffer is full */
|
||||
while (size)
|
||||
{
|
||||
if (serial_ringbuffer_putchar(serial->int_tx, *ptr) != -1)
|
||||
{
|
||||
ptr ++;
|
||||
size --;
|
||||
}
|
||||
else
|
||||
break;
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
/* polling mode */
|
||||
while (size)
|
||||
{
|
||||
/*
|
||||
* to be polite with serial console add a line feed
|
||||
* to the carriage return character
|
||||
*/
|
||||
if (*ptr == '\n' && (dev->flag & RT_DEVICE_FLAG_STREAM))
|
||||
{
|
||||
serial->ops->putc(serial, '\r');
|
||||
}
|
||||
|
||||
serial->ops->putc(serial, *ptr);
|
||||
|
||||
++ptr;
|
||||
--size;
|
||||
}
|
||||
}
|
||||
|
||||
write_nbytes = (rt_uint32_t)ptr - (rt_uint32_t)buffer;
|
||||
if (write_nbytes == 0)
|
||||
{
|
||||
rt_set_errno(-RT_EFULL);
|
||||
}
|
||||
|
||||
return write_nbytes;
|
||||
}
|
||||
|
||||
static rt_err_t rt_serial_control(struct rt_device *dev, rt_uint8_t cmd, void *args)
|
||||
{
|
||||
struct rt_serial_device *serial;
|
||||
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
serial = (struct rt_serial_device *)dev;
|
||||
|
||||
switch (cmd)
|
||||
{
|
||||
case RT_DEVICE_CTRL_SUSPEND:
|
||||
/* suspend device */
|
||||
dev->flag |= RT_DEVICE_FLAG_SUSPENDED;
|
||||
break;
|
||||
|
||||
case RT_DEVICE_CTRL_RESUME:
|
||||
/* resume device */
|
||||
dev->flag &= ~RT_DEVICE_FLAG_SUSPENDED;
|
||||
break;
|
||||
|
||||
case RT_DEVICE_CTRL_CONFIG:
|
||||
/* configure device */
|
||||
serial->ops->configure(serial, (struct serial_configure *)args);
|
||||
break;
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/*
|
||||
* serial register
|
||||
*/
|
||||
rt_err_t rt_hw_serial_register(struct rt_serial_device *serial, const char *name, rt_uint32_t flag, void *data)
|
||||
{
|
||||
struct rt_device *device;
|
||||
RT_ASSERT(serial != RT_NULL);
|
||||
|
||||
device = &(serial->parent);
|
||||
|
||||
device->type = RT_Device_Class_Char;
|
||||
device->rx_indicate = RT_NULL;
|
||||
device->tx_complete = RT_NULL;
|
||||
|
||||
device->init = rt_serial_init;
|
||||
device->open = rt_serial_open;
|
||||
device->close = rt_serial_close;
|
||||
device->read = rt_serial_read;
|
||||
device->write = rt_serial_write;
|
||||
device->control = rt_serial_control;
|
||||
device->user_data = data;
|
||||
|
||||
/* register a character device */
|
||||
return rt_device_register(device, name, flag);
|
||||
}
|
||||
|
||||
/* ISR for serial interrupt */
|
||||
void rt_hw_serial_isr(struct rt_serial_device *serial)
|
||||
{
|
||||
int ch = -1;
|
||||
|
||||
/* interrupt mode receive */
|
||||
RT_ASSERT(serial->parent.flag & RT_DEVICE_FLAG_INT_RX);
|
||||
|
||||
while (1)
|
||||
{
|
||||
ch = serial->ops->getc(serial);
|
||||
if (ch == -1)
|
||||
break;
|
||||
|
||||
serial_ringbuffer_putc(serial->int_rx, ch);
|
||||
}
|
||||
|
||||
/* invoke callback */
|
||||
if (serial->parent.rx_indicate != RT_NULL)
|
||||
{
|
||||
rt_size_t rx_length;
|
||||
|
||||
/* get rx length */
|
||||
rx_length = serial_ringbuffer_size(serial->int_rx);
|
||||
serial->parent.rx_indicate(&serial->parent, rx_length);
|
||||
}
|
||||
}
|
||||
/*
|
||||
* File : serial.c
|
||||
* This file is part of RT-Thread RTOS
|
||||
* COPYRIGHT (C) 2006 - 2012, RT-Thread Development Team
|
||||
*
|
||||
* The license and distribution terms for this file may be
|
||||
* found in the file LICENSE in this distribution or at
|
||||
* http://www.rt-thread.org/license/LICENSE
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2006-03-13 bernard first version
|
||||
* 2012-05-15 lgnq modified according bernard's implementation.
|
||||
* 2012-05-28 bernard code cleanup
|
||||
*/
|
||||
|
||||
#include <rthw.h>
|
||||
#include <rtthread.h>
|
||||
#include <rtdevice.h>
|
||||
|
||||
rt_inline void serial_ringbuffer_init(struct serial_ringbuffer *rbuffer)
|
||||
{
|
||||
rt_memset(rbuffer->buffer, 0, sizeof(rbuffer->buffer));
|
||||
rbuffer->put_index = 0;
|
||||
rbuffer->get_index = 0;
|
||||
}
|
||||
|
||||
rt_inline void serial_ringbuffer_putc(struct serial_ringbuffer *rbuffer,
|
||||
char ch)
|
||||
{
|
||||
rt_base_t level;
|
||||
|
||||
/* disable interrupt */
|
||||
level = rt_hw_interrupt_disable();
|
||||
|
||||
rbuffer->buffer[rbuffer->put_index] = ch;
|
||||
rbuffer->put_index = (rbuffer->put_index + 1) & (SERIAL_RBUFFER_SIZE - 1);
|
||||
|
||||
/* if the next position is read index, discard this 'read char' */
|
||||
if (rbuffer->put_index == rbuffer->get_index)
|
||||
{
|
||||
rbuffer->get_index = (rbuffer->get_index + 1) & (SERIAL_RBUFFER_SIZE - 1);
|
||||
}
|
||||
|
||||
/* enable interrupt */
|
||||
rt_hw_interrupt_enable(level);
|
||||
}
|
||||
|
||||
rt_inline int serial_ringbuffer_putchar(struct serial_ringbuffer *rbuffer,
|
||||
char ch)
|
||||
{
|
||||
rt_base_t level;
|
||||
rt_uint16_t next_index;
|
||||
|
||||
/* disable interrupt */
|
||||
level = rt_hw_interrupt_disable();
|
||||
|
||||
next_index = (rbuffer->put_index + 1) & (SERIAL_RBUFFER_SIZE - 1);
|
||||
if (next_index != rbuffer->get_index)
|
||||
{
|
||||
rbuffer->buffer[rbuffer->put_index] = ch;
|
||||
rbuffer->put_index = next_index;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* enable interrupt */
|
||||
rt_hw_interrupt_enable(level);
|
||||
|
||||
return -1;
|
||||
}
|
||||
|
||||
/* enable interrupt */
|
||||
rt_hw_interrupt_enable(level);
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
rt_inline int serial_ringbuffer_getc(struct serial_ringbuffer *rbuffer)
|
||||
{
|
||||
int ch;
|
||||
rt_base_t level;
|
||||
|
||||
ch = -1;
|
||||
/* disable interrupt */
|
||||
level = rt_hw_interrupt_disable();
|
||||
if (rbuffer->get_index != rbuffer->put_index)
|
||||
{
|
||||
ch = rbuffer->buffer[rbuffer->get_index];
|
||||
rbuffer->get_index = (rbuffer->get_index + 1) & (SERIAL_RBUFFER_SIZE - 1);
|
||||
}
|
||||
/* enable interrupt */
|
||||
rt_hw_interrupt_enable(level);
|
||||
|
||||
return ch;
|
||||
}
|
||||
|
||||
rt_inline rt_uint32_t serial_ringbuffer_size(struct serial_ringbuffer *rbuffer)
|
||||
{
|
||||
rt_uint32_t size;
|
||||
rt_base_t level;
|
||||
|
||||
level = rt_hw_interrupt_disable();
|
||||
size = (rbuffer->put_index - rbuffer->get_index) & (SERIAL_RBUFFER_SIZE - 1);
|
||||
rt_hw_interrupt_enable(level);
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
/* RT-Thread Device Interface */
|
||||
|
||||
/*
|
||||
* This function initializes serial
|
||||
*/
|
||||
static rt_err_t rt_serial_init(struct rt_device *dev)
|
||||
{
|
||||
rt_err_t result = RT_EOK;
|
||||
struct rt_serial_device *serial;
|
||||
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
serial = (struct rt_serial_device *)dev;
|
||||
|
||||
if (!(dev->flag & RT_DEVICE_FLAG_ACTIVATED))
|
||||
{
|
||||
/* apply configuration */
|
||||
if (serial->ops->configure)
|
||||
result = serial->ops->configure(serial, &serial->config);
|
||||
|
||||
if (result != RT_EOK)
|
||||
return result;
|
||||
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_RX)
|
||||
serial_ringbuffer_init(serial->int_rx);
|
||||
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_TX)
|
||||
serial_ringbuffer_init(serial->int_tx);
|
||||
|
||||
/* set activated */
|
||||
dev->flag |= RT_DEVICE_FLAG_ACTIVATED;
|
||||
}
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
static rt_err_t rt_serial_open(struct rt_device *dev, rt_uint16_t oflag)
|
||||
{
|
||||
struct rt_serial_device *serial;
|
||||
rt_uint32_t int_flags = 0;
|
||||
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
serial = (struct rt_serial_device *)dev;
|
||||
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_RX)
|
||||
int_flags = RT_SERIAL_RX_INT;
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_TX)
|
||||
int_flags |= RT_SERIAL_TX_INT;
|
||||
|
||||
if (int_flags)
|
||||
{
|
||||
serial->ops->control(serial, RT_DEVICE_CTRL_SET_INT, (void *)int_flags);
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t rt_serial_close(struct rt_device *dev)
|
||||
{
|
||||
struct rt_serial_device *serial;
|
||||
rt_uint32_t int_flags = 0;
|
||||
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
serial = (struct rt_serial_device *)dev;
|
||||
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_RX)
|
||||
int_flags = RT_SERIAL_RX_INT;
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_TX)
|
||||
int_flags |= RT_SERIAL_TX_INT;
|
||||
|
||||
if (int_flags)
|
||||
{
|
||||
serial->ops->control(serial, RT_DEVICE_CTRL_CLR_INT, (void *)int_flags);
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_size_t rt_serial_read(struct rt_device *dev,
|
||||
rt_off_t pos,
|
||||
void *buffer,
|
||||
rt_size_t size)
|
||||
{
|
||||
rt_uint8_t *ptr;
|
||||
rt_uint32_t read_nbytes;
|
||||
struct rt_serial_device *serial;
|
||||
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
serial = (struct rt_serial_device *)dev;
|
||||
|
||||
ptr = (rt_uint8_t *)buffer;
|
||||
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_RX)
|
||||
{
|
||||
/* interrupt mode Rx */
|
||||
while (size)
|
||||
{
|
||||
int ch;
|
||||
|
||||
ch = serial_ringbuffer_getc(serial->int_rx);
|
||||
if (ch == -1)
|
||||
break;
|
||||
|
||||
*ptr = ch & 0xff;
|
||||
ptr ++;
|
||||
size --;
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
/* polling mode */
|
||||
while ((rt_uint32_t)ptr - (rt_uint32_t)buffer < size)
|
||||
{
|
||||
*ptr = serial->ops->getc(serial);
|
||||
ptr ++;
|
||||
}
|
||||
}
|
||||
|
||||
read_nbytes = (rt_uint32_t)ptr - (rt_uint32_t)buffer;
|
||||
/* set error code */
|
||||
if (read_nbytes == 0)
|
||||
{
|
||||
rt_set_errno(-RT_EEMPTY);
|
||||
}
|
||||
|
||||
return read_nbytes;
|
||||
}
|
||||
|
||||
static rt_size_t rt_serial_write(struct rt_device *dev,
|
||||
rt_off_t pos,
|
||||
const void *buffer,
|
||||
rt_size_t size)
|
||||
{
|
||||
rt_uint8_t *ptr;
|
||||
rt_size_t write_nbytes = 0;
|
||||
struct rt_serial_device *serial;
|
||||
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
serial = (struct rt_serial_device *)dev;
|
||||
|
||||
ptr = (rt_uint8_t*)buffer;
|
||||
|
||||
if (dev->flag & RT_DEVICE_FLAG_INT_TX)
|
||||
{
|
||||
/* warning: data will be discarded if buffer is full */
|
||||
while (size)
|
||||
{
|
||||
if (serial_ringbuffer_putchar(serial->int_tx, *ptr) != -1)
|
||||
{
|
||||
ptr ++;
|
||||
size --;
|
||||
}
|
||||
else
|
||||
break;
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
/* polling mode */
|
||||
while (size)
|
||||
{
|
||||
/*
|
||||
* to be polite with serial console add a line feed
|
||||
* to the carriage return character
|
||||
*/
|
||||
if (*ptr == '\n' && (dev->flag & RT_DEVICE_FLAG_STREAM))
|
||||
{
|
||||
serial->ops->putc(serial, '\r');
|
||||
}
|
||||
|
||||
serial->ops->putc(serial, *ptr);
|
||||
|
||||
++ ptr;
|
||||
-- size;
|
||||
}
|
||||
}
|
||||
|
||||
write_nbytes = (rt_uint32_t)ptr - (rt_uint32_t)buffer;
|
||||
if (write_nbytes == 0)
|
||||
{
|
||||
rt_set_errno(-RT_EFULL);
|
||||
}
|
||||
|
||||
return write_nbytes;
|
||||
}
|
||||
|
||||
static rt_err_t rt_serial_control(struct rt_device *dev,
|
||||
rt_uint8_t cmd,
|
||||
void *args)
|
||||
{
|
||||
struct rt_serial_device *serial;
|
||||
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
serial = (struct rt_serial_device *)dev;
|
||||
|
||||
switch (cmd)
|
||||
{
|
||||
case RT_DEVICE_CTRL_SUSPEND:
|
||||
/* suspend device */
|
||||
dev->flag |= RT_DEVICE_FLAG_SUSPENDED;
|
||||
break;
|
||||
|
||||
case RT_DEVICE_CTRL_RESUME:
|
||||
/* resume device */
|
||||
dev->flag &= ~RT_DEVICE_FLAG_SUSPENDED;
|
||||
break;
|
||||
|
||||
case RT_DEVICE_CTRL_CONFIG:
|
||||
/* configure device */
|
||||
serial->ops->configure(serial, (struct serial_configure *)args);
|
||||
break;
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/*
|
||||
* serial register
|
||||
*/
|
||||
rt_err_t rt_hw_serial_register(struct rt_serial_device *serial,
|
||||
const char *name,
|
||||
rt_uint32_t flag,
|
||||
void *data)
|
||||
{
|
||||
struct rt_device *device;
|
||||
RT_ASSERT(serial != RT_NULL);
|
||||
|
||||
device = &(serial->parent);
|
||||
|
||||
device->type = RT_Device_Class_Char;
|
||||
device->rx_indicate = RT_NULL;
|
||||
device->tx_complete = RT_NULL;
|
||||
|
||||
device->init = rt_serial_init;
|
||||
device->open = rt_serial_open;
|
||||
device->close = rt_serial_close;
|
||||
device->read = rt_serial_read;
|
||||
device->write = rt_serial_write;
|
||||
device->control = rt_serial_control;
|
||||
device->user_data = data;
|
||||
|
||||
/* register a character device */
|
||||
return rt_device_register(device, name, flag);
|
||||
}
|
||||
|
||||
/* ISR for serial interrupt */
|
||||
void rt_hw_serial_isr(struct rt_serial_device *serial)
|
||||
{
|
||||
int ch = -1;
|
||||
|
||||
/* interrupt mode receive */
|
||||
RT_ASSERT(serial->parent.flag & RT_DEVICE_FLAG_INT_RX);
|
||||
|
||||
while (1)
|
||||
{
|
||||
ch = serial->ops->getc(serial);
|
||||
if (ch == -1)
|
||||
break;
|
||||
|
||||
serial_ringbuffer_putc(serial->int_rx, ch);
|
||||
}
|
||||
|
||||
/* invoke callback */
|
||||
if (serial->parent.rx_indicate != RT_NULL)
|
||||
{
|
||||
rt_size_t rx_length;
|
||||
|
||||
/* get rx length */
|
||||
rx_length = serial_ringbuffer_size(serial->int_rx);
|
||||
serial->parent.rx_indicate(&serial->parent, rx_length);
|
||||
}
|
||||
}
|
||||
|
|
|
|||
Loading…
Reference in New Issue