-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathdrv_can_ymodem.c
90 lines (66 loc) · 2.06 KB
/
drv_can_ymodem.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
/*
* Copyright (c) 2019-2020, redoc
*
* SPDX-License-Identifier: Apache-2.0
*
* Change Logs:
* Date Author Notes
* 2020-04-29 redoc the first version
*/
#include "board.h"
#include "thread_can.h"
#include "can_ymodem.h"
#include "drv_can_ymodem.h"
//#define DRV_DEBUG
#define LOG_TAG "drv.can_ymodem"
#include <drv_log.h>
#define CAN_ID_KEYBOARD0_TO_SC_FILE (0x30)
struct rt_can_ymodem_device can_ymodem_device;
static rt_err_t can_file_send(uint32_t can_id, can_cmd_file_t cmd, uint8_t *buffer, uint8_t size);
static rt_err_t can_file_send(uint32_t can_id, can_cmd_file_t cmd, uint8_t *buffer, uint8_t size)
{
uint8_t *pdata = rt_calloc(1, 8);
if(0 == size)
{
log_e("can file send size can't be zero!");
goto __exit;
}
*pdata = cmd;
rt_memcpy(pdata + CAN_FILE_CMD_SIZE, buffer, size);
can_send(can_id, pdata, size + CAN_FILE_CMD_SIZE);
rt_free(pdata);
return RT_EOK;
__exit:
rt_free(pdata);
return -RT_ERROR;
}
static int rt_hw_can_ymodem_send(struct rt_can_ymodem_device *can_ymodem,
const void *buffer,
rt_size_t size)
{
if(CAN_ID_KEYBOARD0_TO_SC_FILE == can_ymodem->channel)
{
can_file_send(can_ymodem->channel, CAN_CMD_FILE_FILE_SLAVE, (uint8_t*)buffer, size);
}
return RT_EOK;
}
void drv_can_ymodem_recv(uint32_t ch, const void *buffer, rt_size_t size)
{
if(CAN_ID_KEYBOARD0_TO_SC_FILE == ch)
{
rt_can_ymodem_rx(&can_ymodem_device, buffer, size);
}
}
static const struct rt_can_ymodem_ops topctrl_can_ymodem_ops =
{
.puts = rt_hw_can_ymodem_send,
};
int rt_hw_can_ymodem_init(void)
{
rt_err_t result = 0;
can_ymodem_device.ops = &topctrl_can_ymodem_ops;
can_ymodem_device.channel = CAN_ID_KEYBOARD0_TO_SC_FILE;
result = rt_hw_can_ymodem_register(&can_ymodem_device, "can_ymodem", RT_DEVICE_FLAG_RDWR, RT_NULL);
return result;
}
INIT_DEVICE_EXPORT(rt_hw_can_ymodem_init);