src/usb_stdio.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

#include "usb_stdio.h"

#include "pico/stdio.h"
#include "pico/stdio/driver.h"
#include "tusb.h"

static void usb_stdio_write(const char *buf, int len);
static void usb_stdio_flush(void);
static int usb_stdio_read(char *buf, int len);

static struct stdio_driver usb_stdio = {
	.out_chars = usb_stdio_write,
	.out_flush = usb_stdio_flush,
	.in_chars = usb_stdio_read,
	.next = NULL
};

void
usb_stdio_write(const char *buf, int len)
{
	tud_cdc_write(buf, (uint32_t) len);
}

void
usb_stdio_flush(void)
{
	tud_cdc_write_flush();
	tud_task();
}

int
usb_stdio_read(char *buf, int len)
{
	return (int) tud_cdc_read(buf, (uint32_t) len);
}

void
usb_stdio_init(void)
{
	stdio_set_driver_enabled(&usb_stdio, true);
	stdio_set_translate_crlf(&usb_stdio, true);
	stdio_init_all();
}