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
|
#include <rcc/rcc.h>
#include <os/time.h>
#include <interrupt/interrupt.h>
#include <timer/timer.h>
#include <gpio/gpio.h>
#include <usb/usb.h>
#include <usb/descriptor.h>
#include "hmc5983.h"
#include "mpu6000.h"
Pin usb_vbus = GPIOB[5];
Pin usb_dm = GPIOA[11];
Pin usb_dp = GPIOA[12];
Pin spi2_sck = GPIOB[13];
Pin spi2_miso = GPIOB[14];
Pin spi2_mosi = GPIOB[15];
Pin bar_cs = GPIOC[13];
Pin mag_cs = GPIOC[14];
Pin mpu_cs = GPIOC[15];
Pin flash_cs = GPIOB[2];
Pin s1 = GPIOA[0];
Pin s2 = GPIOA[1];
auto dev_desc = device_desc(0x200, 0, 0, 0, 64, 0x1234, 0x5678, 0, 0, 0, 0, 1);
auto conf_desc = configuration_desc(1, 1, 0, 0xc0, 0,
interface_desc(1, 0, 1, 0xff, 0x00, 0x00, 0,
endpoint_desc(0x81, 0x02, 64, 0) // IN
)
);
desc_t dev_desc_p = {sizeof(dev_desc), (void*)&dev_desc};
desc_t conf_desc_p = {sizeof(conf_desc), (void*)&conf_desc};
USB_f1 usb(USB, dev_desc_p, conf_desc_p);
class USB_TM : public USB_class_driver {
private:
USB_generic& usb;
uint32_t buf[16];
public:
USB_TM(USB_generic& usbd) : usb(usbd) {
usb.register_driver(this);
}
protected:
virtual void handle_set_configuration(uint8_t configuration) {
if (configuration) {
usb.hw_conf_ep(0x81, EPType::Bulk, 64);
usb.register_out_handler(this, 1);
}
}
};
USB_TM usb_tm(usb);
HMC5983 magn(mag_cs, SPI2);
MPU6000 mpu(mpu_cs, SPI2);
int main() {
rcc_init();
// Initialize system timer.
STK.LOAD = 72000000 / 8 / 1000; // 1000 Hz
STK.CTRL = 0x03;
RCC.enable(RCC.GPIOA);
RCC.enable(RCC.GPIOB);
RCC.enable(RCC.GPIOC);
usb_dm.set_mode(Pin::AF);
usb_dm.set_af(14);
usb_dp.set_mode(Pin::AF);
usb_dp.set_af(14);
RCC.enable(RCC.USB);
usb.init();
RCC.enable(RCC.SPI2);
spi2_sck.set_mode(Pin::AF);
spi2_sck.set_af(5);
spi2_mosi.set_mode(Pin::AF);
spi2_mosi.set_af(5);
spi2_miso.set_mode(Pin::AF);
spi2_miso.set_af(5);
mag_cs.set_mode(Pin::Output);
mag_cs.on();
bar_cs.set_mode(Pin::Output);
bar_cs.on();
mpu_cs.set_mode(Pin::Output);
mpu_cs.on();
flash_cs.set_mode(Pin::Output);
flash_cs.on();
magn.init();
mpu.init();
float buf[9] = {0,0,0,0,0,0,0,0,0};
while(1) {
usb.process();
uint8_t magn_status = magn.update();
mpu.update();
buf[0] = magn.x;
buf[1] = magn.y;
buf[2] = magn.z;
buf[3] = mpu.gyro[0];
buf[4] = mpu.gyro[1];
buf[5] = mpu.gyro[2];
buf[6] = mpu.accel[0];
buf[7] = mpu.accel[1];
buf[8] = mpu.accel[2];
if(usb.ep_ready(1)) {
usb.write(1, (uint32_t*)buf, sizeof(buf));
//usb.write(1, (uint32_t*)mpu.gyro, sizeof(mpu.gyro));
//usb.write(1, (uint32_t*)&magn_status, sizeof(magn_status));
}
}
}
|
