fix osc
This commit is contained in:
@@ -1,133 +0,0 @@
|
||||
|
||||
#include <rtthread.h>
|
||||
#include <rtdevice.h>
|
||||
#include <string.h>
|
||||
|
||||
#include "chrg_can.h"
|
||||
|
||||
#define LOG_TAG "chrg.can"
|
||||
#define DBG_LEVEL DBG_LOG
|
||||
#include <rtdbg.h>
|
||||
|
||||
struct chrg_can_t chrgcan[TOTAL_CAN] = {
|
||||
[IDX_CAN_1] = {
|
||||
.dev = RT_NULL,
|
||||
.name = DEV_NAME_CAN,
|
||||
.index = IDX_CAN_1,
|
||||
}
|
||||
};
|
||||
|
||||
rt_err_t chrg_can1_write (rt_uint8_t id, rt_uint8_t *data, rt_uint16_t len)
|
||||
{
|
||||
rt_size_t size = 0;
|
||||
struct rt_can_msg msg;
|
||||
struct chrg_can_t *pCAN = &chrgcan[IDX_CAN_1];
|
||||
|
||||
msg.id = id;
|
||||
msg.ide = RT_CAN_STDID;
|
||||
msg.rtr = RT_CAN_DTR;
|
||||
|
||||
if (len <= 8) {
|
||||
msg.len = len;
|
||||
memcpy(msg.data, data, len);
|
||||
} else {
|
||||
return RT_EINVAL;
|
||||
}
|
||||
|
||||
size = rt_device_write(pCAN->dev, 0, &msg, sizeof(msg));
|
||||
if (0 == size) {
|
||||
rt_kprintf("dev '%s' write failed.\r\n", pCAN->name);
|
||||
return RT_ERROR;
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
|
||||
static rt_err_t chrg_can1_rx_callback(rt_device_t dev, rt_size_t size)
|
||||
{
|
||||
|
||||
rt_sem_release(&chrgcan[IDX_CAN_1].rx_sem);
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static void chrg_can_rx_thread (void *data)
|
||||
{
|
||||
int i = 0;
|
||||
struct rt_can_msg rxmsg = {0};
|
||||
struct chrg_can_t *pCAN = (struct chrg_can_t *)data;
|
||||
|
||||
if (RT_NULL == pCAN) {
|
||||
return ;
|
||||
}
|
||||
|
||||
if (IDX_CAN_1 == pCAN->index) {
|
||||
rt_device_set_rx_indicate(pCAN->dev, chrg_can1_rx_callback);
|
||||
} else {
|
||||
return ;
|
||||
}
|
||||
|
||||
|
||||
while (1) {
|
||||
//rxmsg.hdr = -1; // 直接从 uselist 链表读取数据
|
||||
|
||||
rt_sem_take(&pCAN->rx_sem, RT_WAITING_FOREVER);
|
||||
|
||||
rt_device_read(pCAN->dev, 0, &rxmsg, sizeof(rxmsg));
|
||||
|
||||
rt_kprintf("ID : %02x ", rxmsg.id);
|
||||
for (i = 0; i < 8; i++) {
|
||||
rt_kprintf("%02X ", rxmsg.data[i]);
|
||||
}
|
||||
rt_kprintf("\r\n", rxmsg.id);
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
static int chrg_can_init (void)
|
||||
{
|
||||
int i = 0;
|
||||
rt_err_t ret = 0;
|
||||
rt_thread_t tid;
|
||||
|
||||
struct chrg_can_t *pCAN = RT_NULL;
|
||||
|
||||
for (i = 0; i < TOTAL_CAN; i++) {
|
||||
pCAN = &chrgcan[i];
|
||||
|
||||
pCAN->dev = rt_device_find(pCAN->name);
|
||||
if (RT_NULL == pCAN->dev) {
|
||||
rt_kprintf("dev '%s' not found.\r\n", pCAN->name);
|
||||
|
||||
continue;
|
||||
}
|
||||
|
||||
rt_sem_init(&pCAN->rx_sem, pCAN->name, 0, RT_IPC_FLAG_FIFO);
|
||||
|
||||
ret = rt_device_open(pCAN->dev, RT_DEVICE_FLAG_INT_TX | RT_DEVICE_FLAG_INT_RX);
|
||||
if (RT_EOK != ret) {
|
||||
rt_kprintf("open '%s' failed.\r\n", pCAN->name);
|
||||
continue;
|
||||
}
|
||||
|
||||
tid = rt_thread_create(pCAN->name, chrg_can_rx_thread, pCAN, 1024, 25, 10);
|
||||
if (tid != RT_NULL) {
|
||||
rt_thread_startup(tid);
|
||||
} else {
|
||||
rt_kprintf("create thread '%s' failed.\r\n", pCAN->name);
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
INIT_APP_EXPORT(chrg_can_init);
|
||||
|
||||
|
||||
@@ -1,32 +0,0 @@
|
||||
#ifndef __CHRG_CAN_H__
|
||||
#define __CHRG_CAN_H__
|
||||
|
||||
#include <rtthread.h>
|
||||
#include <rtdevice.h>
|
||||
|
||||
#define DEV_NAME_CAN "can1"
|
||||
|
||||
typedef enum {
|
||||
IDX_CAN_1 = 0, // 0
|
||||
|
||||
TOTAL_CAN
|
||||
} eIDX_CAN;
|
||||
|
||||
struct chrg_can_t {
|
||||
rt_device_t dev;
|
||||
struct rt_semaphore rx_sem;
|
||||
|
||||
const char *name;
|
||||
eIDX_CAN index;
|
||||
|
||||
};
|
||||
|
||||
extern struct chrg_can_t chrgcan[TOTAL_CAN];
|
||||
|
||||
extern rt_err_t chrg_can1_write (rt_uint8_t id, rt_uint8_t *data, rt_uint16_t len);
|
||||
|
||||
|
||||
|
||||
#endif
|
||||
|
||||
|
||||
@@ -25,6 +25,9 @@ int main(void)
|
||||
finsh_set_prompt("chrg ");
|
||||
#endif
|
||||
|
||||
extern void cdc_acm_init(uint8_t busid, uintptr_t reg_base);
|
||||
cdc_acm_init(0, USB_OTG_FS_PERIPH_BASE);
|
||||
|
||||
while (1) {
|
||||
rt_thread_mdelay(1000);
|
||||
chrg_wdt_feed();
|
||||
|
||||
Reference in New Issue
Block a user