renamed patch (#103)

Co-authored-by: Maxim Devaev <mdevaev@gmail.com>
This commit is contained in:
tomaszduda23 2022-07-16 02:52:32 +09:00 committed by GitHub
parent 95e9b7dd75
commit 24651f4db3
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
2 changed files with 139 additions and 116 deletions

View File

@ -41,120 +41,24 @@
#ifdef AUM #ifdef AUM
# include "aum.h" # include "aum.h"
#endif #endif
#include "outputs.h"
#include "factory.h"
// -----------------------------------------------------------------------------
static DRIVERS::Keyboard *_kbd = nullptr;
static DRIVERS::Mouse *_mouse = nullptr;
#ifdef HID_DYNAMIC #ifdef HID_DYNAMIC
static bool _reset_required = false; static bool _reset_required = false;
static DRIVERS::Storage *_storage = nullptr;
static int _readOutputs(void) {
uint8_t data[8];
_storage->readBlock(data, 0, 8);
if (data[0] != PROTO::MAGIC || PROTO::crc16(data, 6) != PROTO::merge8(data[6], data[7])) {
return -1;
}
return data[1];
}
static void _writeOutputs(uint8_t mask, uint8_t outputs, bool force) {
int old = 0;
if (!force) {
old = _readOutputs();
if (old < 0) {
old = 0;
}
}
uint8_t data[8] = {0};
data[0] = PROTO::MAGIC;
data[1] = (old & ~mask) | outputs;
PROTO::split16(PROTO::crc16(data, 6), &data[6], &data[7]);
_storage->updateBlock(data, 0, 8);
}
#endif #endif
static Outputs _out;
static void _initOutputs() {
int outputs;
# ifdef HID_DYNAMIC
_storage = DRIVERS::Factory::makeStorage(DRIVERS::NON_VOLATILE_STORAGE);
outputs = _readOutputs();
if (outputs < 0) {
# endif
outputs = 0;
# if defined(HID_WITH_USB) && defined(HID_SET_USB_KBD)
outputs |= PROTO::OUTPUTS1::KEYBOARD::USB;
# elif defined(HID_WITH_PS2) && defined(HID_SET_PS2_KBD)
outputs |= PROTO::OUTPUTS1::KEYBOARD::PS2;
# endif
# if defined(HID_WITH_USB) && defined(HID_SET_USB_MOUSE_ABS)
outputs |= PROTO::OUTPUTS1::MOUSE::USB_ABS;
# elif defined(HID_WITH_USB) && defined(HID_SET_USB_MOUSE_REL)
outputs |= PROTO::OUTPUTS1::MOUSE::USB_REL;
# elif defined(HID_WITH_PS2) && defined(HID_SET_PS2_MOUSE)
outputs |= PROTO::OUTPUTS1::MOUSE::PS2;
# elif defined(HID_WITH_USB) && defined(HID_WITH_USB_WIN98) && defined(HID_SET_USB_MOUSE_WIN98)
outputs |= PROTO::OUTPUTS1::MOUSE::USB_WIN98;
# endif
# ifdef HID_DYNAMIC
_writeOutputs(0xFF, outputs, true);
}
# endif
uint8_t kbd = outputs & PROTO::OUTPUTS1::KEYBOARD::MASK;
switch (kbd) {
case PROTO::OUTPUTS1::KEYBOARD::USB:
_kbd = DRIVERS::Factory::makeKeyboard(DRIVERS::USB_KEYBOARD);
break;
case PROTO::OUTPUTS1::KEYBOARD::PS2:
_kbd = DRIVERS::Factory::makeKeyboard(DRIVERS::PS2_KEYBOARD);
break;
default:
_kbd = DRIVERS::Factory::makeKeyboard(DRIVERS::DUMMY);
break;
}
uint8_t mouse = outputs & PROTO::OUTPUTS1::MOUSE::MASK;
switch (mouse) {
case PROTO::OUTPUTS1::MOUSE::USB_ABS:
_mouse = DRIVERS::Factory::makeMouse(DRIVERS::USB_MOUSE_ABSOLUTE);
break;
case PROTO::OUTPUTS1::MOUSE::USB_WIN98:
_mouse = DRIVERS::Factory::makeMouse(DRIVERS::USB_MOUSE_ABSOLUTE_WIN98);
break;
case PROTO::OUTPUTS1::MOUSE::USB_REL:
_mouse = DRIVERS::Factory::makeMouse(DRIVERS::USB_MOUSE_RELATIVE);
break;
default:
_mouse = DRIVERS::Factory::makeMouse(DRIVERS::DUMMY);
break;
}
# ifdef ARDUINO_ARCH_AVR
USBDevice.attach();
# endif
_kbd->begin();
_mouse->begin();
}
// ----------------------------------------------------------------------------- // -----------------------------------------------------------------------------
static void _cmdSetKeyboard(const uint8_t *data) { // 1 bytes static void _cmdSetKeyboard(const uint8_t *data) { // 1 bytes
# ifdef HID_DYNAMIC # ifdef HID_DYNAMIC
_writeOutputs(PROTO::OUTPUTS1::KEYBOARD::MASK, data[0], false); _out.writeOutputs(PROTO::OUTPUTS1::KEYBOARD::MASK, data[0], false);
_reset_required = true; _reset_required = true;
# endif # endif
} }
static void _cmdSetMouse(const uint8_t *data) { // 1 bytes static void _cmdSetMouse(const uint8_t *data) { // 1 bytes
# ifdef HID_DYNAMIC # ifdef HID_DYNAMIC
_writeOutputs(PROTO::OUTPUTS1::MOUSE::MASK, data[0], false); _out.writeOutputs(PROTO::OUTPUTS1::MOUSE::MASK, data[0], false);
_reset_required = true; _reset_required = true;
# endif # endif
} }
@ -166,19 +70,19 @@ static void _cmdSetConnected(const uint8_t *data) { // 1 byte
} }
static void _cmdClearHid(const uint8_t *_) { // 0 bytes static void _cmdClearHid(const uint8_t *_) { // 0 bytes
_kbd->clear(); _out.kbd->clear();
_mouse->clear(); _out.mouse->clear();
} }
static void _cmdKeyEvent(const uint8_t *data) { // 2 bytes static void _cmdKeyEvent(const uint8_t *data) { // 2 bytes
_kbd->sendKey(data[0], data[1]); _out.kbd->sendKey(data[0], data[1]);
} }
static void _cmdMouseButtonEvent(const uint8_t *data) { // 2 bytes static void _cmdMouseButtonEvent(const uint8_t *data) { // 2 bytes
# define MOUSE_PAIR(_state, _button) \ # define MOUSE_PAIR(_state, _button) \
_state & PROTO::CMD::MOUSE::_button::SELECT, \ _state & PROTO::CMD::MOUSE::_button::SELECT, \
_state & PROTO::CMD::MOUSE::_button::STATE _state & PROTO::CMD::MOUSE::_button::STATE
_mouse->sendButtons( _out.mouse->sendButtons(
MOUSE_PAIR(data[0], LEFT), MOUSE_PAIR(data[0], LEFT),
MOUSE_PAIR(data[0], RIGHT), MOUSE_PAIR(data[0], RIGHT),
MOUSE_PAIR(data[0], MIDDLE), MOUSE_PAIR(data[0], MIDDLE),
@ -190,19 +94,19 @@ static void _cmdMouseButtonEvent(const uint8_t *data) { // 2 bytes
static void _cmdMouseMoveEvent(const uint8_t *data) { // 4 bytes static void _cmdMouseMoveEvent(const uint8_t *data) { // 4 bytes
// See /kvmd/apps/otg/hid/keyboard.py for details // See /kvmd/apps/otg/hid/keyboard.py for details
_mouse->sendMove( _out.mouse->sendMove(
PROTO::merge8_int(data[0], data[1]), PROTO::merge8_int(data[0], data[1]),
PROTO::merge8_int(data[2], data[3]) PROTO::merge8_int(data[2], data[3])
); );
} }
static void _cmdMouseRelativeEvent(const uint8_t *data) { // 2 bytes static void _cmdMouseRelativeEvent(const uint8_t *data) { // 2 bytes
_mouse->sendRelative(data[0], data[1]); _out.mouse->sendRelative(data[0], data[1]);
} }
static void _cmdMouseWheelEvent(const uint8_t *data) { // 2 bytes static void _cmdMouseWheelEvent(const uint8_t *data) { // 2 bytes
// Y only, X is not supported // Y only, X is not supported
_mouse->sendWheel(data[1]); _out.mouse->sendWheel(data[1]);
} }
static uint8_t _handleRequest(const uint8_t *data) { // 8 bytes static uint8_t _handleRequest(const uint8_t *data) { // 8 bytes
@ -247,13 +151,13 @@ static void _sendResponse(uint8_t code) {
} }
response[2] = PROTO::OUTPUTS1::DYNAMIC; response[2] = PROTO::OUTPUTS1::DYNAMIC;
# endif # endif
if (_kbd->getType() != DRIVERS::DUMMY) { if (_out.kbd->getType() != DRIVERS::DUMMY) {
response[1] |= (_kbd->isOffline() ? PROTO::PONG::KEYBOARD_OFFLINE : 0); response[1] |= (_out.kbd->isOffline() ? PROTO::PONG::KEYBOARD_OFFLINE : 0);
DRIVERS::KeyboardLedsState leds = _kbd->getLeds(); DRIVERS::KeyboardLedsState leds = _out.kbd->getLeds();
response[1] |= (leds.caps ? PROTO::PONG::CAPS : 0); response[1] |= (leds.caps ? PROTO::PONG::CAPS : 0);
response[1] |= (leds.num ? PROTO::PONG::NUM : 0); response[1] |= (leds.num ? PROTO::PONG::NUM : 0);
response[1] |= (leds.scroll ? PROTO::PONG::SCROLL : 0); response[1] |= (leds.scroll ? PROTO::PONG::SCROLL : 0);
switch (_kbd->getType()) { switch (_out.kbd->getType()) {
case DRIVERS::USB_KEYBOARD: case DRIVERS::USB_KEYBOARD:
response[2] |= PROTO::OUTPUTS1::KEYBOARD::USB; response[2] |= PROTO::OUTPUTS1::KEYBOARD::USB;
break; break;
@ -262,9 +166,9 @@ static void _sendResponse(uint8_t code) {
break; break;
} }
} }
if (_mouse->getType() != DRIVERS::DUMMY) { if (_out.mouse->getType() != DRIVERS::DUMMY) {
response[1] |= (_mouse->isOffline() ? PROTO::PONG::MOUSE_OFFLINE : 0); response[1] |= (_out.mouse->isOffline() ? PROTO::PONG::MOUSE_OFFLINE : 0);
switch (_mouse->getType()) { switch (_out.mouse->getType()) {
case DRIVERS::USB_MOUSE_ABSOLUTE_WIN98: case DRIVERS::USB_MOUSE_ABSOLUTE_WIN98:
response[2] |= PROTO::OUTPUTS1::MOUSE::USB_WIN98; response[2] |= PROTO::OUTPUTS1::MOUSE::USB_WIN98;
break; break;
@ -304,7 +208,7 @@ static void _sendResponse(uint8_t code) {
} }
void setup() { void setup() {
_initOutputs(); _out.initOutputs();
# ifdef AUM # ifdef AUM
aumInit(); aumInit();
@ -322,7 +226,7 @@ void loop() {
aumProxyUsbVbus(); aumProxyUsbVbus();
# endif # endif
_kbd->periodic(); _out.kbd->periodic();
# ifdef CMD_SERIAL # ifdef CMD_SERIAL
static unsigned long last = micros(); static unsigned long last = micros();

119
hid/src/outputs.h Normal file
View File

@ -0,0 +1,119 @@
/*****************************************************************************
# #
# KVMD - The main PiKVM daemon. #
# #
# Copyright (C) 2018-2022 Maxim Devaev <mdevaev@gmail.com> #
# #
# 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 "factory.h"
#include "proto.h"
class Outputs {
public:
void writeOutputs(uint8_t mask, uint8_t outputs, bool force) {
int old = 0;
if (!force) {
old = _readOutputs();
if (old < 0) {
old = 0;
}
}
uint8_t data[8] = {0};
data[0] = PROTO::MAGIC;
data[1] = (old & ~mask) | outputs;
PROTO::split16(PROTO::crc16(data, 6), &data[6], &data[7]);
_storage->updateBlock(data, 0, 8);
}
void initOutputs() {
int outputs;
# ifdef HID_DYNAMIC
_storage = DRIVERS::Factory::makeStorage(DRIVERS::NON_VOLATILE_STORAGE);
# else
_storage = DRIVERS::Factory::makeStorage(DRIVERS::DUMMY);
# endif
outputs = _readOutputs();
if (outputs < 0) {
outputs = 0;
# if defined(HID_WITH_USB) && defined(HID_SET_USB_KBD)
outputs |= PROTO::OUTPUTS1::KEYBOARD::USB;
# elif defined(HID_WITH_PS2) && defined(HID_SET_PS2_KBD)
outputs |= PROTO::OUTPUTS1::KEYBOARD::PS2;
# endif
# if defined(HID_WITH_USB) && defined(HID_SET_USB_MOUSE_ABS)
outputs |= PROTO::OUTPUTS1::MOUSE::USB_ABS;
# elif defined(HID_WITH_USB) && defined(HID_SET_USB_MOUSE_REL)
outputs |= PROTO::OUTPUTS1::MOUSE::USB_REL;
# elif defined(HID_WITH_PS2) && defined(HID_SET_PS2_MOUSE)
outputs |= PROTO::OUTPUTS1::MOUSE::PS2;
# elif defined(HID_WITH_USB) && defined(HID_WITH_USB_WIN98) && defined(HID_SET_USB_MOUSE_WIN98)
outputs |= PROTO::OUTPUTS1::MOUSE::USB_WIN98;
# endif
writeOutputs(0xFF, outputs, true);
}
uint8_t kbd_type = outputs & PROTO::OUTPUTS1::KEYBOARD::MASK;
switch (kbd_type) {
case PROTO::OUTPUTS1::KEYBOARD::USB:
kbd = DRIVERS::Factory::makeKeyboard(DRIVERS::USB_KEYBOARD);
break;
case PROTO::OUTPUTS1::KEYBOARD::PS2:
kbd = DRIVERS::Factory::makeKeyboard(DRIVERS::PS2_KEYBOARD);
break;
default:
kbd = DRIVERS::Factory::makeKeyboard(DRIVERS::DUMMY);
break;
}
uint8_t mouse_type = outputs & PROTO::OUTPUTS1::MOUSE::MASK;
switch (mouse_type) {
case PROTO::OUTPUTS1::MOUSE::USB_ABS:
mouse = DRIVERS::Factory::makeMouse(DRIVERS::USB_MOUSE_ABSOLUTE);
break;
case PROTO::OUTPUTS1::MOUSE::USB_WIN98:
mouse = DRIVERS::Factory::makeMouse(DRIVERS::USB_MOUSE_ABSOLUTE_WIN98);
break;
case PROTO::OUTPUTS1::MOUSE::USB_REL:
mouse = DRIVERS::Factory::makeMouse(DRIVERS::USB_MOUSE_RELATIVE);
break;
default:
mouse = DRIVERS::Factory::makeMouse(DRIVERS::DUMMY);
break;
}
# ifdef ARDUINO_ARCH_AVR
USBDevice.attach();
# endif
kbd->begin();
mouse->begin();
}
DRIVERS::Keyboard *kbd = nullptr;
DRIVERS::Mouse *mouse = nullptr;
private:
int _readOutputs(void) {
uint8_t data[8];
_storage->readBlock(data, 0, 8);
if (data[0] != PROTO::MAGIC || PROTO::crc16(data, 6) != PROTO::merge8(data[6], data[7])) {
return -1;
}
return data[1];
}
DRIVERS::Storage *_storage = nullptr;
};