forked from PX4/PX4-Bootloader
-
Notifications
You must be signed in to change notification settings - Fork 0
/
usart.c
71 lines (56 loc) · 1.33 KB
/
usart.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
/*
* USART interface for the bootloader.
*/
#ifdef STM32F4
# include <libopencm3/stm32/f4/rcc.h>
# include <libopencm3/stm32/f4/gpio.h>
#endif
#include <libopencm3/stm32/usart.h>
#include "bl.h"
uint32_t usart;
void
cinit(void *config)
{
usart = (uint32_t)config;
/* board is expected to do pin and clock setup */
/* do usart setup */
//USART_CR1(usart) |= (1 << 15); /* because libopencm3 doesn't know the OVER8 bit */
usart_set_baudrate(usart, 115200);
usart_set_databits(usart, 8);
usart_set_stopbits(usart, USART_STOPBITS_1);
usart_set_mode(usart, USART_MODE_TX_RX);
usart_set_parity(usart, USART_PARITY_NONE);
usart_set_flow_control(usart, USART_FLOWCONTROL_NONE);
/* and enable */
usart_enable(usart);
#if 0
usart_send_blocking(usart, 'B');
usart_send_blocking(usart, 'B');
usart_send_blocking(usart, 'B');
usart_send_blocking(usart, 'B');
while (true) {
int c;
c = usart_recv_blocking(usart);
usart_send_blocking(usart, c);
}
#endif
}
void
cfini(void)
{
usart_disable(usart);
}
int
cin(void)
{
int c = -1;
if (USART_SR(usart) & USART_SR_RXNE)
c = usart_recv(usart);
return c;
}
void
cout(uint8_t *buf, unsigned len)
{
while (len--)
usart_send_blocking(usart, *buf++);
}