-
Notifications
You must be signed in to change notification settings - Fork 2
/
usb_echo.cxx
162 lines (115 loc) · 4 KB
/
usb_echo.cxx
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
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
// papoon_usb: "Not Insane" USB library for STM32F103xx MCUs
// Copyright (C) 2019,2020 Mark R. Rubin
//
// This file is part of papoon_usb.
//
// The papoon_usb program is free software: you can redistribute it
// and/or modify it under the terms of the GNU General Public License
// as published by the Free Software Foundation, either version 3 of
// the License, or (at your option) any later version.
//
// The papoon_usb program is distributed in the hope that it will be
// useful, but WITHOUT ANY WARRANTY; without even the implied warranty
// of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
// General Public License for more details.
//
// You should have received a copy of the GNU General Public License
// (LICENSE.txt) along with the papoon_usb program. If not, see
// <https://www.gnu.org/licenses/gpl.html>
#include <stdint.h>
#include <core_cm3.hxx>
#include <stm32f103xb.hxx>
#include <bin_to_hex.hxx>
#include <sys_tick_timer.hxx>
#include <usb_dev.hxx>
#include <usb_mcu_init.hxx>
using namespace stm32f103xb;
using namespace stm32f10_12357_xx;
extern UsbDev usb_dev;
arm::SysTickTimer sys_tick_timer;
static const uint32_t CPU_HZ = 72000000,
LED_DELAY_TICK = CPU_HZ / 50; // 0.020 seconds
#ifdef USB_DEV_INTERRUPT_DRIVEN
extern "C" void USB_LP_CAN1_RX0_IRQHandler()
{
usb_dev.interrupt_handler();
}
#endif
namespace usb_echo {
void init()
{
usb_dev.serial_number_init(); // do before mcu_init() clock speed breaks
usb_mcu_init ();
usb_gpio_init();
sys_tick_timer.init();
gpioc->bsrr = Gpio::Bsrr::BS13; // turn off user LED by setting high
#ifdef USB_DEV_INTERRUPT_DRIVEN
arm::nvic->iser.set(arm::NvicIrqn::USB_LP_CAN1_RX0);
#endif
}
void wait_configured()
{
gpioc->bsrr = Gpio::Bsrr::BR13; // turn on user LED by setting low
while (usb_dev.device_state() != UsbDev::DeviceState::CONFIGURED)
#ifndef USB_DEV_INTERRUPT_DRIVEN
usb_dev.poll();
#else
asm("nop");
#endif
gpioc->bsrr = Gpio::Bsrr::BS13; // set high to turn off user LED
}
void run(
uint8_t *recv_buf ,
uint8_t *send_buf ,
uint8_t send_max ,
const uint8_t recv_endpt,
const uint8_t send_endpt)
{
uint16_t recv_len = 0,
msg_count = 0,
send_len = 0;
while (true) {
if ( !gpioc->odr.any(Gpio::Odr::ODR13)
&& sys_tick_timer.elapsed32() > LED_DELAY_TICK)
gpioc->bsrr = Gpio::Bsrr::BS13; // set high to turn off user LED
#ifndef USB_DEV_INTERRUPT_DRIVEN
usb_dev.poll();
#endif
if (recv_len = usb_dev.recv(recv_endpt, recv_buf)) {
gpioc->bsrr = Gpio::Bsrr::BR13; // set low turn on user LED
sys_tick_timer.begin32();
uint8_t recv_ndx = 0,
sub_count = 0;
while (recv_ndx < recv_len) {
// 0123456...
// cccc+ ....
bitops::BinToHex::uint16(msg_count,
reinterpret_cast<char*>(send_buf));
if (sub_count++ == 0) send_buf[4] = ' ';
else send_buf[4] = '+';
send_buf[5] = ' ';
send_len = 6;
while (recv_ndx < recv_len && send_len < send_max - 1)
send_buf[send_len++] = recv_buf[recv_ndx++];
send_buf[send_len++] = '\n';
while (!usb_dev.send(send_endpt, send_buf, send_len))
#ifdef USB_DEV_INTERRUPT_DRIVEN
asm("wfi");
#else
usb_dev.poll();
#endif
}
if (send_len == send_max)
// exactly IN endpoint size
// have to send zero-length xfer to let host know is end
while (!usb_dev.send(send_endpt, send_buf, 0))
#ifdef USB_DEV_INTERRUPT_DRIVEN
asm("wfi");
#else
usb_dev.poll();
#endif
++msg_count;
}
}
}
} // namespace usb_echo