blob: d9fc4552db07bf8b046242043c6af369a10d6d35 (
plain)
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
|
/*****************************************************************************
# #
# KVMD - The main PiKVM daemon. #
# #
# Copyright (C) 2018-2024 Maxim Devaev <[email protected]> #
# #
# This 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. #
# #
# This 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 #
# along with this program. If not, see <https://www.gnu.org/licenses/>. #
# #
*****************************************************************************/
#include "ph_com_bridge.h"
#include "pico/stdlib.h"
#include "tusb.h"
#include "ph_types.h"
#define _TIMEOUT_US 100000
static u8 _buf[8] = {0};
static u8 _index = 0;
static u64 _last_ts = 0;
static void (*_data_cb)(const u8 *) = NULL;
static void (*_timeout_cb)(void) = NULL;
void ph_com_bridge_init(void (*data_cb)(const u8 *), void (*timeout_cb)(void)) {
_data_cb = data_cb;
_timeout_cb = timeout_cb;
}
void ph_com_bridge_task(void) {
if (!tud_cdc_connected()) {
tud_cdc_write_clear();
return;
}
if (tud_cdc_available() > 0) {
const s32 ch = tud_cdc_read_char();
if (ch < 0) {
goto no_data;
}
_buf[_index] = (u8)ch;
if (_index == 7) {
_data_cb(_buf);
_index = 0;
} else {
_last_ts = time_us_64();
++_index;
}
return;
}
no_data:
if (_index > 0) {
if (_last_ts + _TIMEOUT_US < time_us_64()) {
_timeout_cb();
_index = 0;
}
}
}
void ph_com_bridge_write(const u8 *data) {
if (tud_cdc_connected()) {
tud_cdc_write(data, 8);
tud_cdc_write_flush();
}
}
|
