import RT-Thread@9217865c without bsp, libcpu and components/net
This commit is contained in:
commit
e2376a3709
1414 changed files with 390370 additions and 0 deletions
13
components/utilities/rt-link/src/SConscript
Normal file
13
components/utilities/rt-link/src/SConscript
Normal file
|
@ -0,0 +1,13 @@
|
|||
Import('rtconfig')
|
||||
from building import *
|
||||
|
||||
cwd = GetCurrentDir()
|
||||
src = Glob('*.c')
|
||||
CPPPATH = [cwd + '/../inc']
|
||||
|
||||
group = DefineGroup('rt-link', src, depend = ['RT_USING_RT_LINK'], CPPPATH = CPPPATH)
|
||||
|
||||
if os.path.isfile(os.path.join(cwd, 'hw', 'SConscript')):
|
||||
group = group + SConscript(os.path.join('hw', 'SConscript'))
|
||||
|
||||
Return('group')
|
1320
components/utilities/rt-link/src/rtlink.c
Normal file
1320
components/utilities/rt-link/src/rtlink.c
Normal file
File diff suppressed because it is too large
Load diff
398
components/utilities/rt-link/src/rtlink_dev.c
Normal file
398
components/utilities/rt-link/src/rtlink_dev.c
Normal file
|
@ -0,0 +1,398 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2021-06-15 Sherman the first version
|
||||
*/
|
||||
|
||||
#define DBG_TAG "RTLINK_DEV"
|
||||
#define DBG_LVL DBG_LOG
|
||||
#include <rtdbg.h>
|
||||
|
||||
#include <rthw.h>
|
||||
#include <rtthread.h>
|
||||
#include <rtdevice.h>
|
||||
#include <rtlink_dev.h>
|
||||
|
||||
#define RTLINK_SERV(dev) (((struct rt_link_device*)dev)->service)
|
||||
|
||||
#ifdef RT_USING_POSIX_DEVIO
|
||||
#include <unistd.h>
|
||||
#include <sys/stat.h>
|
||||
#include <sys/statfs.h>
|
||||
#include <poll.h>
|
||||
|
||||
int rtlink_fops_open(struct dfs_file *fd)
|
||||
{
|
||||
rt_uint16_t flags = 0;
|
||||
rt_device_t device;
|
||||
|
||||
switch (fd->flags & O_ACCMODE)
|
||||
{
|
||||
case O_RDONLY:
|
||||
LOG_D("fops open: O_RDONLY!");
|
||||
flags = RT_DEVICE_FLAG_RDONLY;
|
||||
break;
|
||||
case O_WRONLY:
|
||||
LOG_D("fops open: O_WRONLY!");
|
||||
flags = RT_DEVICE_FLAG_WRONLY;
|
||||
break;
|
||||
case O_RDWR:
|
||||
LOG_D("fops open: O_RDWR!");
|
||||
flags = RT_DEVICE_FLAG_RDWR;
|
||||
break;
|
||||
default:
|
||||
LOG_E("fops open: unknown mode - %d!", fd->flags & O_ACCMODE);
|
||||
break;
|
||||
}
|
||||
|
||||
device = (rt_device_t)fd->vnode->data;
|
||||
if (fd->flags & O_NONBLOCK)
|
||||
{
|
||||
rt_device_control(device, RT_LINK_TX_NONBLOCKING | RT_LINK_RX_NONBLOCKING, RT_NULL);
|
||||
}
|
||||
|
||||
return rt_device_open(device, flags);
|
||||
}
|
||||
|
||||
int rtlink_fops_close(struct dfs_file *fd)
|
||||
{
|
||||
rt_device_t device;
|
||||
device = (rt_device_t)fd->vnode->data;
|
||||
|
||||
rt_device_set_rx_indicate(device, RT_NULL);
|
||||
return rt_device_close(device);
|
||||
}
|
||||
|
||||
int rtlink_fops_ioctl(struct dfs_file *fd, int cmd, void *args)
|
||||
{
|
||||
rt_device_t device;
|
||||
device = (rt_device_t)fd->vnode->data;
|
||||
|
||||
if (cmd == O_NONBLOCK)
|
||||
{
|
||||
return rt_device_control(device, RT_LINK_TX_NONBLOCKING | RT_LINK_RX_NONBLOCKING, RT_NULL);
|
||||
}
|
||||
else
|
||||
{
|
||||
return rt_device_control(device, cmd, args);
|
||||
}
|
||||
}
|
||||
|
||||
int rtlink_fops_read(struct dfs_file *fd, void *buf, size_t count)
|
||||
{
|
||||
int size = 0;
|
||||
rt_device_t device;
|
||||
device = (rt_device_t)fd->vnode->data;
|
||||
|
||||
size = rt_device_read(device, -1, buf, count);
|
||||
if (size <= 0)
|
||||
{
|
||||
size = -EAGAIN;
|
||||
}
|
||||
return size;
|
||||
}
|
||||
|
||||
int rtlink_fops_write(struct dfs_file *fd, const void *buf, size_t count)
|
||||
{
|
||||
int size = 0;
|
||||
rt_device_t device;
|
||||
device = (rt_device_t)fd->vnode->data;
|
||||
|
||||
size = rt_device_write(device, -1, buf, count);
|
||||
if (size <= 0)
|
||||
{
|
||||
size = -EAGAIN;
|
||||
}
|
||||
return size;
|
||||
}
|
||||
|
||||
int rtlink_fops_poll(struct dfs_file *fd, struct rt_pollreq *req)
|
||||
{
|
||||
int mask = 0;
|
||||
int flags = 0;
|
||||
rt_device_t device;
|
||||
struct rt_link_device *rtlink_dev;
|
||||
|
||||
device = (rt_device_t)fd->vnode->data;
|
||||
RT_ASSERT(device != RT_NULL);
|
||||
|
||||
rtlink_dev = (struct rt_link_device *)device;
|
||||
|
||||
flags = fd->flags & O_ACCMODE;
|
||||
if (flags == O_RDONLY || flags == O_RDWR)
|
||||
{
|
||||
rt_base_t level;
|
||||
rt_poll_add(&(device->wait_queue), req);
|
||||
|
||||
level = rt_hw_interrupt_disable();
|
||||
if (RT_NULL != rt_slist_first(&rtlink_dev->recv_head))
|
||||
mask |= POLLIN;
|
||||
rt_hw_interrupt_enable(level);
|
||||
}
|
||||
mask |= POLLOUT;
|
||||
|
||||
return mask;
|
||||
}
|
||||
|
||||
const static struct dfs_file_ops _rtlink_fops =
|
||||
{
|
||||
rtlink_fops_open,
|
||||
rtlink_fops_close,
|
||||
rtlink_fops_ioctl,
|
||||
rtlink_fops_read,
|
||||
rtlink_fops_write,
|
||||
RT_NULL, /* flush */
|
||||
RT_NULL, /* lseek */
|
||||
RT_NULL, /* getdents */
|
||||
rtlink_fops_poll,
|
||||
};
|
||||
#endif /* RT_USING_POSIX_DEVIO */
|
||||
|
||||
/* The event type for the service channel number,
|
||||
* which is used to wake up the service thread in blocking receive mode */
|
||||
struct rt_event recv_event;
|
||||
|
||||
static rt_err_t rt_link_event_send(struct rt_link_service *serv)
|
||||
{
|
||||
RT_ASSERT(serv != RT_NULL);
|
||||
RT_ASSERT(serv->service < RT_LINK_SERVICE_MAX);
|
||||
rt_uint32_t set = 0x01 << serv->service;
|
||||
return rt_event_send(&recv_event, set);
|
||||
}
|
||||
|
||||
static rt_err_t rt_link_event_recv(struct rt_link_service *service)
|
||||
{
|
||||
RT_ASSERT(service != RT_NULL);
|
||||
RT_ASSERT(service->service < RT_LINK_SERVICE_MAX);
|
||||
|
||||
rt_uint32_t set = 0x01 << service->service;
|
||||
rt_uint32_t recved = 0;
|
||||
rt_err_t ret = rt_event_recv(&recv_event,
|
||||
set,
|
||||
RT_EVENT_FLAG_AND | RT_EVENT_FLAG_CLEAR,
|
||||
RT_WAITING_FOREVER,
|
||||
&recved);
|
||||
if (recved & set)
|
||||
{
|
||||
return ret;
|
||||
}
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
static void send_cb(struct rt_link_service *service, void *buffer)
|
||||
{
|
||||
RT_ASSERT(service != RT_NULL);
|
||||
RT_ASSERT(buffer != RT_NULL);
|
||||
struct rt_link_device *rtlink = (struct rt_link_device *)service->user_data;
|
||||
|
||||
if (rtlink && rtlink->parent.tx_complete)
|
||||
{
|
||||
rtlink->parent.tx_complete(&rtlink->parent, buffer);
|
||||
}
|
||||
}
|
||||
|
||||
static void recv_cb(struct rt_link_service *service, void *data, rt_size_t size)
|
||||
{
|
||||
RT_ASSERT(service != RT_NULL);
|
||||
struct rt_link_device *rtlink = (struct rt_link_device *)service->user_data;
|
||||
|
||||
if (rtlink)
|
||||
{
|
||||
struct rtlink_recv_list *node = rt_malloc(sizeof(struct rtlink_recv_list));
|
||||
node->data = data;
|
||||
node->size = size;
|
||||
node->index = 0;
|
||||
rt_slist_append(&rtlink->recv_head, &node->list);
|
||||
rt_link_event_send(service);
|
||||
|
||||
if (rtlink->parent.rx_indicate)
|
||||
{
|
||||
rtlink->parent.rx_indicate(&rtlink->parent, size);
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
rt_free(data);
|
||||
}
|
||||
}
|
||||
|
||||
rt_err_t rt_link_dev_init(rt_device_t dev)
|
||||
{
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
|
||||
dev->rx_indicate = RT_NULL;
|
||||
dev->tx_complete = RT_NULL;
|
||||
|
||||
struct rt_link_device *rtlink = (struct rt_link_device *)dev;
|
||||
rtlink->service.service = RT_LINK_SERVICE_MAX;
|
||||
rtlink->service.recv_cb = RT_NULL;
|
||||
rtlink->service.send_cb = RT_NULL;
|
||||
rtlink->service.timeout_tx = RT_WAITING_NO;
|
||||
rtlink->service.user_data = (void *)dev;
|
||||
|
||||
rt_slist_init(&rtlink->recv_head);
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
rt_err_t rt_link_dev_open(rt_device_t dev, rt_uint16_t oflag)
|
||||
{
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
struct rt_link_device *rtlink = (struct rt_link_device *)dev;
|
||||
|
||||
rtlink->service.recv_cb = recv_cb;
|
||||
rtlink->service.send_cb = send_cb;
|
||||
|
||||
dev->open_flag = oflag & RT_DEVICE_OFLAG_MASK;
|
||||
if (dev->open_flag == RT_DEVICE_OFLAG_RDONLY)
|
||||
{
|
||||
rtlink->service.send_cb = RT_NULL;
|
||||
}
|
||||
else if (dev->open_flag == RT_DEVICE_OFLAG_WRONLY)
|
||||
{
|
||||
rtlink->service.recv_cb = RT_NULL;
|
||||
}
|
||||
return rt_link_service_attach(&rtlink->service);
|
||||
}
|
||||
|
||||
rt_err_t rt_link_dev_close(rt_device_t dev)
|
||||
{
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
struct rt_link_device *rtlink = (struct rt_link_device *)dev;
|
||||
return rt_link_service_detach(&rtlink->service);
|
||||
}
|
||||
|
||||
rt_ssize_t rt_link_dev_read(rt_device_t dev, rt_off_t pos, void *buffer, rt_size_t size)
|
||||
{
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
RT_ASSERT(buffer != RT_NULL);
|
||||
RT_ASSERT(size != 0);
|
||||
|
||||
struct rt_link_device *rtlink = (struct rt_link_device *)dev;
|
||||
struct rtlink_recv_list *node;
|
||||
rt_size_t read_len = 0;
|
||||
rt_size_t unread_len = 0;
|
||||
|
||||
if (dev->rx_indicate == RT_NULL)
|
||||
{
|
||||
/* RT_LINK_RX_BLOCKING, wait service receive data event */
|
||||
rt_link_event_recv(&rtlink->service);
|
||||
}
|
||||
|
||||
if (rt_slist_first(&rtlink->recv_head) != RT_NULL)
|
||||
{
|
||||
node = rt_container_of(rt_slist_next(&rtlink->recv_head), struct rtlink_recv_list, list);
|
||||
unread_len = (node->size) - (node->index);
|
||||
read_len = (size > unread_len) ? unread_len : size;
|
||||
rt_memcpy(buffer, (rt_uint8_t *)node->data + node->index, read_len);
|
||||
node->index += read_len;
|
||||
|
||||
if (node->index >= node->size)
|
||||
{
|
||||
rt_slist_remove(&rtlink->recv_head, &node->list);
|
||||
node->index = 0;
|
||||
rt_free(node->data);
|
||||
rt_free(node);
|
||||
}
|
||||
if (rt_slist_first(&rtlink->recv_head) != RT_NULL)
|
||||
{
|
||||
rt_link_event_send(&rtlink->service);
|
||||
}
|
||||
}
|
||||
return read_len;
|
||||
}
|
||||
|
||||
rt_ssize_t rt_link_dev_write(rt_device_t dev, rt_off_t pos, const void *buffer, rt_size_t size)
|
||||
{
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
RT_ASSERT(buffer != RT_NULL);
|
||||
RT_ASSERT(size != 0);
|
||||
|
||||
return rt_link_send(&RTLINK_SERV(dev), buffer, size);
|
||||
}
|
||||
|
||||
rt_err_t rt_link_dev_control(rt_device_t dev, int cmd, void *args)
|
||||
{
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
|
||||
if (cmd & RT_DEVICE_CTRL_CONFIG)
|
||||
{
|
||||
if (args == RT_NULL)
|
||||
return -RT_EINVAL;
|
||||
RTLINK_SERV(dev).service = ((struct rt_link_service *)args)->service;
|
||||
RTLINK_SERV(dev).timeout_tx = ((struct rt_link_service *)args)->timeout_tx;
|
||||
RTLINK_SERV(dev).flag = ((struct rt_link_service *)args)->flag;
|
||||
}
|
||||
|
||||
if (cmd & RT_LINK_RX_BLOCKING)
|
||||
{
|
||||
dev->rx_indicate = RT_NULL;
|
||||
}
|
||||
if (cmd & RT_LINK_TX_BLOCKING)
|
||||
{
|
||||
RTLINK_SERV(dev).timeout_tx = RT_WAITING_FOREVER;
|
||||
dev->tx_complete = RT_NULL;
|
||||
}
|
||||
if (cmd & RT_LINK_TX_NONBLOCKING)
|
||||
{
|
||||
RTLINK_SERV(dev).timeout_tx = RT_WAITING_NO;
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
#ifdef RT_USING_DEVICE_OPS
|
||||
const static struct rt_device_ops rtlink_ops =
|
||||
{
|
||||
rt_link_dev_init,
|
||||
rt_link_dev_open,
|
||||
rt_link_dev_close,
|
||||
rt_link_dev_read,
|
||||
rt_link_dev_write,
|
||||
rt_link_dev_control
|
||||
};
|
||||
#endif /* RT_USING_DEVICE_OPS */
|
||||
|
||||
/*
|
||||
* rtlink device register
|
||||
*/
|
||||
rt_err_t rt_link_dev_register(struct rt_link_device *rtlink,
|
||||
const char *name,
|
||||
rt_uint32_t flag,
|
||||
void *data)
|
||||
{
|
||||
rt_err_t ret;
|
||||
struct rt_device *device;
|
||||
RT_ASSERT(rtlink != RT_NULL);
|
||||
|
||||
device = (struct rt_device *)rtlink;
|
||||
device->type = RT_Device_Class_Char;
|
||||
device->rx_indicate = RT_NULL;
|
||||
device->tx_complete = RT_NULL;
|
||||
|
||||
#ifdef RT_USING_DEVICE_OPS
|
||||
device->ops = &rtlink_ops;
|
||||
#else
|
||||
device->init = rt_link_dev_init;
|
||||
device->open = rt_link_dev_open;
|
||||
device->close = rt_link_dev_close;
|
||||
device->read = rt_link_dev_read;
|
||||
device->write = rt_link_dev_write;
|
||||
device->control = rt_link_dev_control;
|
||||
#endif
|
||||
device->user_data = data;
|
||||
|
||||
/* register a character device */
|
||||
ret = rt_device_register(device, name, flag);
|
||||
|
||||
#ifdef RT_USING_POSIX_DEVIO
|
||||
/* set fops */
|
||||
device->fops = &_rtlink_fops;
|
||||
#endif
|
||||
|
||||
rt_event_init(&recv_event, "rtlink_dev", RT_IPC_FLAG_FIFO);
|
||||
return ret;
|
||||
}
|
296
components/utilities/rt-link/src/rtlink_hw.c
Normal file
296
components/utilities/rt-link/src/rtlink_hw.c
Normal file
|
@ -0,0 +1,296 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2021-02-02 xiangxistu the first version
|
||||
* 2021-05-08 Sherman Optimize the operation function on the rt_link_receive_buffer
|
||||
*/
|
||||
|
||||
#include <rtthread.h>
|
||||
|
||||
#include <rtlink.h>
|
||||
#include <rtlink_hw.h>
|
||||
#include <rtlink_port.h>
|
||||
#include <rtlink_utils.h>
|
||||
|
||||
#define DBG_TAG "rtlink_hw"
|
||||
#ifdef USING_RT_LINK_HW_DEBUG
|
||||
#define DBG_LVL DBG_LOG
|
||||
#else
|
||||
#define DBG_LVL DBG_INFO
|
||||
#endif
|
||||
#define DBG_COLOR
|
||||
#include <rtdbg.h>
|
||||
|
||||
static struct rt_link_receive_buffer *rx_buffer = RT_NULL;
|
||||
|
||||
struct rt_link_receive_buffer *rt_link_hw_buffer_init(void *parameter)
|
||||
{
|
||||
rx_buffer = rt_malloc(sizeof(struct rt_link_receive_buffer));
|
||||
if (rx_buffer != RT_NULL)
|
||||
{
|
||||
rt_memset(rx_buffer, 0, sizeof(struct rt_link_receive_buffer));
|
||||
rx_buffer->read_point = rx_buffer->data;
|
||||
rx_buffer->write_point = rx_buffer->data;
|
||||
rx_buffer->end_point = rx_buffer->data + RT_LINK_RECEIVE_BUFFER_LENGTH; /* Point to memory that has no access rights */
|
||||
}
|
||||
else
|
||||
{
|
||||
LOG_E("receive buffer alloc failed, init failed.");
|
||||
}
|
||||
|
||||
return rx_buffer;
|
||||
}
|
||||
|
||||
static rt_ssize_t rt_link_hw_buffer_write(void *data, rt_size_t count)
|
||||
{
|
||||
rt_size_t surplus = 0;
|
||||
if (rx_buffer == RT_NULL)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
/* (data)----(r)----(w)----(end) */
|
||||
if (rx_buffer->write_point >= rx_buffer->read_point)
|
||||
{
|
||||
rt_size_t w2end = rx_buffer->end_point - rx_buffer->write_point;
|
||||
surplus = RT_LINK_RECEIVE_BUFFER_LENGTH - (rx_buffer->write_point - rx_buffer->read_point);
|
||||
count = count > surplus ? surplus : count;
|
||||
if (count >= w2end)
|
||||
{
|
||||
rt_memcpy(rx_buffer->write_point, data, w2end);
|
||||
rx_buffer->write_point = rx_buffer->data;
|
||||
|
||||
rt_memcpy(rx_buffer->write_point, (rt_uint8_t *)data + w2end, (count - w2end));
|
||||
rx_buffer->write_point += (count - w2end);
|
||||
}
|
||||
else
|
||||
{
|
||||
rt_memcpy(rx_buffer->write_point, data, count);
|
||||
rx_buffer->write_point += count;
|
||||
}
|
||||
}
|
||||
else /* (data)----(w)----(r)----(end) */
|
||||
{
|
||||
surplus = rx_buffer->read_point - rx_buffer->write_point;
|
||||
count = count > surplus ? surplus : count;
|
||||
rt_memcpy(rx_buffer->write_point, data, count);
|
||||
rx_buffer->write_point += count;
|
||||
}
|
||||
return count;
|
||||
}
|
||||
|
||||
/* increases buffer pointer by one and circle around if necessary */
|
||||
void rt_link_hw_buffer_point_shift(rt_uint8_t **pointer_address, rt_size_t length)
|
||||
{
|
||||
rt_uint8_t *pointer = *pointer_address + length;
|
||||
|
||||
if (rx_buffer->write_point >= rx_buffer->read_point)
|
||||
{
|
||||
if (pointer >= rx_buffer->write_point)
|
||||
{
|
||||
*pointer_address = rx_buffer->write_point;
|
||||
}
|
||||
else
|
||||
{
|
||||
*pointer_address = pointer;
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
if (pointer >= rx_buffer->end_point)
|
||||
{
|
||||
*pointer_address = rx_buffer->data;
|
||||
pointer = pointer - rx_buffer->end_point + rx_buffer->data;
|
||||
|
||||
if (pointer >= rx_buffer->write_point)
|
||||
{
|
||||
*pointer_address = rx_buffer->write_point;
|
||||
}
|
||||
else
|
||||
{
|
||||
*pointer_address = pointer;
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
*pointer_address = pointer;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* copy data from receive buffer */
|
||||
void rt_link_hw_copy(rt_uint8_t *dst, rt_uint8_t *src, rt_size_t count)
|
||||
{
|
||||
rt_uint8_t *pointer = RT_NULL;
|
||||
|
||||
pointer = src + count;
|
||||
if (pointer >= rx_buffer->end_point)
|
||||
{
|
||||
rt_size_t offset = 0;
|
||||
offset = rx_buffer->end_point - src;
|
||||
rt_memcpy(dst, src, offset);
|
||||
rt_memcpy(dst + offset, rx_buffer->data, pointer - rx_buffer->end_point);
|
||||
}
|
||||
else
|
||||
{
|
||||
rt_memcpy(dst, src, count);
|
||||
}
|
||||
}
|
||||
|
||||
/* Length of data received */
|
||||
rt_size_t rt_link_hw_recv_len(struct rt_link_receive_buffer *buffer)
|
||||
{
|
||||
if (buffer == RT_NULL)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
if (buffer->write_point >= buffer->read_point)
|
||||
{
|
||||
return (buffer->write_point - buffer->read_point);
|
||||
}
|
||||
else
|
||||
{
|
||||
return (RT_LINK_RECEIVE_BUFFER_LENGTH - (buffer->read_point - buffer->write_point));
|
||||
}
|
||||
}
|
||||
|
||||
rt_err_t rt_link_reset_crc32(void)
|
||||
{
|
||||
#ifdef RT_LINK_USING_HW_CRC
|
||||
return rt_link_hw_crc32_reset();
|
||||
#else
|
||||
return rt_link_sf_crc32_reset();
|
||||
#endif
|
||||
}
|
||||
|
||||
rt_uint32_t rt_link_crc32(rt_uint8_t *data, rt_size_t u32_size)
|
||||
{
|
||||
#ifdef RT_LINK_USING_HW_CRC
|
||||
return rt_link_hw_crc32(data, u32_size);
|
||||
#else
|
||||
return rt_link_sf_crc32(data, u32_size);
|
||||
#endif
|
||||
}
|
||||
|
||||
rt_uint32_t rt_link_get_crc(rt_uint8_t using_buffer_ring, rt_uint8_t *data, rt_size_t size)
|
||||
{
|
||||
rt_uint32_t crc32 = 0x0;
|
||||
rt_size_t surplus = 0;
|
||||
|
||||
if (data == RT_NULL)
|
||||
{
|
||||
LOG_D("warning, the parameter error: %d, data: 0x%08d.", size, data);
|
||||
return 0;
|
||||
}
|
||||
|
||||
rt_link_reset_crc32();
|
||||
if (using_buffer_ring == 1)
|
||||
{
|
||||
/* modify the missing character */
|
||||
surplus = rx_buffer->end_point - data;
|
||||
if (surplus >= size)
|
||||
{
|
||||
crc32 = rt_link_crc32(data, size);
|
||||
}
|
||||
else
|
||||
{
|
||||
rt_link_crc32(data, surplus);
|
||||
crc32 = rt_link_crc32(rx_buffer->data, size - surplus);
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
crc32 = rt_link_crc32(data, size);
|
||||
}
|
||||
return crc32;
|
||||
}
|
||||
|
||||
rt_size_t rt_link_hw_send(void *data, rt_size_t length)
|
||||
{
|
||||
rt_size_t send_len = 0;
|
||||
send_len = rt_link_port_send(data, length);
|
||||
if (send_len <= 0)
|
||||
{
|
||||
rt_link_port_reconnect();
|
||||
send_len = rt_link_port_send(data, length);
|
||||
}
|
||||
return send_len;
|
||||
}
|
||||
|
||||
rt_size_t rt_link_hw_write_cb(void *data, rt_size_t length)
|
||||
{
|
||||
/* write real data into rtlink receive buffer */
|
||||
rt_size_t len = rt_link_hw_buffer_write(data, length);
|
||||
struct rt_link_session *scb = rt_link_get_scb();
|
||||
if (scb)
|
||||
{
|
||||
rt_event_send(&scb->event, RT_LINK_READ_CHECK_EVENT);
|
||||
}
|
||||
return len;
|
||||
}
|
||||
|
||||
rt_err_t rt_link_hw_init(void)
|
||||
{
|
||||
struct rt_link_session *scb = rt_link_get_scb();
|
||||
if ((rx_buffer != RT_NULL) || (scb == RT_NULL))
|
||||
{
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
/* alloc receive buffer to store data */
|
||||
if (rt_link_hw_buffer_init(RT_NULL) == RT_NULL)
|
||||
{
|
||||
return -RT_ENOMEM;
|
||||
}
|
||||
scb->rx_buffer = rx_buffer;
|
||||
scb->calculate_crc = rt_link_get_crc;
|
||||
|
||||
if (RT_EOK != rt_link_port_init())
|
||||
{
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
#ifdef LINK_LAYER_USING_HW_CRC
|
||||
/* crc hardware device for mcu and node */
|
||||
if (RT_EOK != rt_link_hw_crc32_init())
|
||||
{
|
||||
return -RT_ERROR;
|
||||
}
|
||||
#endif
|
||||
|
||||
LOG_I("link layer hardware environment init successful.");
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
rt_err_t rt_link_hw_deinit(void)
|
||||
{
|
||||
if (rx_buffer)
|
||||
{
|
||||
rt_free(rx_buffer);
|
||||
rx_buffer = RT_NULL;
|
||||
}
|
||||
struct rt_link_session *scb = rt_link_get_scb();
|
||||
if (scb)
|
||||
{
|
||||
scb->rx_buffer = rx_buffer;
|
||||
scb->calculate_crc = RT_NULL;
|
||||
}
|
||||
if (RT_EOK != rt_link_port_deinit())
|
||||
{
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
#ifdef LINK_LAYER_USING_HW_CRC
|
||||
/* crc hardware device for mcu and node */
|
||||
if (RT_EOK != rt_link_hw_crc32_deinit())
|
||||
{
|
||||
return -RT_ERROR;
|
||||
}
|
||||
#endif
|
||||
|
||||
LOG_I("rtlink hardware deinit successful.");
|
||||
return RT_EOK;
|
||||
}
|
90
components/utilities/rt-link/src/rtlink_utils.c
Normal file
90
components/utilities/rt-link/src/rtlink_utils.c
Normal file
|
@ -0,0 +1,90 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2021-05-15 Sherman the first version
|
||||
*/
|
||||
|
||||
#include <rtlink_utils.h>
|
||||
|
||||
/* Calculate the number of '1' */
|
||||
int rt_link_utils_num1(rt_uint32_t n)
|
||||
{
|
||||
int ret = 0;
|
||||
while (n)
|
||||
{
|
||||
n &= n - 1;
|
||||
ret++;
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
#ifdef RT_LINK_USING_SF_CRC
|
||||
|
||||
static rt_uint32_t crc = 0xffffffff;
|
||||
const rt_uint32_t crc_table[256] =
|
||||
{
|
||||
0x00000000, 0x77073096, 0xEE0E612C, 0x990951BA, 0x076DC419,
|
||||
0x706AF48F, 0xE963A535, 0x9E6495A3, 0x0EDB8832, 0x79DCB8A4, 0xE0D5E91E, 0x97D2D988,
|
||||
0x09B64C2B, 0x7EB17CBD, 0xE7B82D07, 0x90BF1D91, 0x1DB71064, 0x6AB020F2, 0xF3B97148,
|
||||
0x84BE41DE, 0x1ADAD47D, 0x6DDDE4EB, 0xF4D4B551, 0x83D385C7, 0x136C9856, 0x646BA8C0,
|
||||
0xFD62F97A, 0x8A65C9EC, 0x14015C4F, 0x63066CD9, 0xFA0F3D63, 0x8D080DF5, 0x3B6E20C8,
|
||||
0x4C69105E, 0xD56041E4, 0xA2677172, 0x3C03E4D1, 0x4B04D447, 0xD20D85FD, 0xA50AB56B,
|
||||
0x35B5A8FA, 0x42B2986C, 0xDBBBC9D6, 0xACBCF940, 0x32D86CE3, 0x45DF5C75, 0xDCD60DCF,
|
||||
0xABD13D59, 0x26D930AC, 0x51DE003A, 0xC8D75180, 0xBFD06116, 0x21B4F4B5, 0x56B3C423,
|
||||
0xCFBA9599, 0xB8BDA50F, 0x2802B89E, 0x5F058808, 0xC60CD9B2, 0xB10BE924, 0x2F6F7C87,
|
||||
0x58684C11, 0xC1611DAB, 0xB6662D3D, 0x76DC4190, 0x01DB7106, 0x98D220BC, 0xEFD5102A,
|
||||
0x71B18589, 0x06B6B51F, 0x9FBFE4A5, 0xE8B8D433, 0x7807C9A2, 0x0F00F934, 0x9609A88E,
|
||||
0xE10E9818, 0x7F6A0DBB, 0x086D3D2D, 0x91646C97, 0xE6635C01, 0x6B6B51F4, 0x1C6C6162,
|
||||
0x856530D8, 0xF262004E, 0x6C0695ED, 0x1B01A57B, 0x8208F4C1, 0xF50FC457, 0x65B0D9C6,
|
||||
0x12B7E950, 0x8BBEB8EA, 0xFCB9887C, 0x62DD1DDF, 0x15DA2D49, 0x8CD37CF3, 0xFBD44C65,
|
||||
0x4DB26158, 0x3AB551CE, 0xA3BC0074, 0xD4BB30E2, 0x4ADFA541, 0x3DD895D7, 0xA4D1C46D,
|
||||
0xD3D6F4FB, 0x4369E96A, 0x346ED9FC, 0xAD678846, 0xDA60B8D0, 0x44042D73, 0x33031DE5,
|
||||
0xAA0A4C5F, 0xDD0D7CC9, 0x5005713C, 0x270241AA, 0xBE0B1010, 0xC90C2086, 0x5768B525,
|
||||
0x206F85B3, 0xB966D409, 0xCE61E49F, 0x5EDEF90E, 0x29D9C998, 0xB0D09822, 0xC7D7A8B4,
|
||||
0x59B33D17, 0x2EB40D81, 0xB7BD5C3B, 0xC0BA6CAD, 0xEDB88320, 0x9ABFB3B6, 0x03B6E20C,
|
||||
0x74B1D29A, 0xEAD54739, 0x9DD277AF, 0x04DB2615, 0x73DC1683, 0xE3630B12, 0x94643B84,
|
||||
0x0D6D6A3E, 0x7A6A5AA8, 0xE40ECF0B, 0x9309FF9D, 0x0A00AE27, 0x7D079EB1, 0xF00F9344,
|
||||
0x8708A3D2, 0x1E01F268, 0x6906C2FE, 0xF762575D, 0x806567CB, 0x196C3671, 0x6E6B06E7,
|
||||
0xFED41B76, 0x89D32BE0, 0x10DA7A5A, 0x67DD4ACC, 0xF9B9DF6F, 0x8EBEEFF9, 0x17B7BE43,
|
||||
0x60B08ED5, 0xD6D6A3E8, 0xA1D1937E, 0x38D8C2C4, 0x4FDFF252, 0xD1BB67F1, 0xA6BC5767,
|
||||
0x3FB506DD, 0x48B2364B, 0xD80D2BDA, 0xAF0A1B4C, 0x36034AF6, 0x41047A60, 0xDF60EFC3,
|
||||
0xA867DF55, 0x316E8EEF, 0x4669BE79, 0xCB61B38C, 0xBC66831A, 0x256FD2A0, 0x5268E236,
|
||||
0xCC0C7795, 0xBB0B4703, 0x220216B9, 0x5505262F, 0xC5BA3BBE, 0xB2BD0B28, 0x2BB45A92,
|
||||
0x5CB36A04, 0xC2D7FFA7, 0xB5D0CF31, 0x2CD99E8B, 0x5BDEAE1D, 0x9B64C2B0, 0xEC63F226,
|
||||
0x756AA39C, 0x026D930A, 0x9C0906A9, 0xEB0E363F, 0x72076785, 0x05005713, 0x95BF4A82,
|
||||
0xE2B87A14, 0x7BB12BAE, 0x0CB61B38, 0x92D28E9B, 0xE5D5BE0D, 0x7CDCEFB7, 0x0BDBDF21,
|
||||
0x86D3D2D4, 0xF1D4E242, 0x68DDB3F8, 0x1FDA836E, 0x81BE16CD, 0xF6B9265B, 0x6FB077E1,
|
||||
0x18B74777, 0x88085AE6, 0xFF0F6A70, 0x66063BCA, 0x11010B5C, 0x8F659EFF, 0xF862AE69,
|
||||
0x616BFFD3, 0x166CCF45, 0xA00AE278, 0xD70DD2EE, 0x4E048354, 0x3903B3C2, 0xA7672661,
|
||||
0xD06016F7, 0x4969474D, 0x3E6E77DB, 0xAED16A4A, 0xD9D65ADC, 0x40DF0B66, 0x37D83BF0,
|
||||
0xA9BCAE53, 0xDEBB9EC5, 0x47B2CF7F, 0x30B5FFE9, 0xBDBDF21C, 0xCABAC28A, 0x53B39330,
|
||||
0x24B4A3A6, 0xBAD03605, 0xCDD70693, 0x54DE5729, 0x23D967BF, 0xB3667A2E, 0xC4614AB8,
|
||||
0x5D681B02, 0x2A6F2B94, 0xB40BBE37, 0xC30C8EA1, 0x5A05DF1B, 0x2D02EF8D
|
||||
};
|
||||
|
||||
rt_err_t rt_link_sf_crc32_reset(void)
|
||||
{
|
||||
crc = 0xffffffff;
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
rt_uint32_t rt_link_sf_crc32(rt_uint8_t *data, rt_size_t len)
|
||||
{
|
||||
rt_uint32_t x, y;
|
||||
x = 0;
|
||||
y = 0;
|
||||
rt_size_t i;
|
||||
|
||||
for (i = 0; i < len; i++)
|
||||
{
|
||||
y = (crc ^ data[i]) & 0xff;
|
||||
x = crc_table[y];
|
||||
crc = (crc >> 8) ^ x;
|
||||
}
|
||||
return (crc ^ 0xffffffff);
|
||||
}
|
||||
#endif /* RT_LINK_USING_SF_CRC */
|
Loading…
Add table
Add a link
Reference in a new issue