Mistel__MD770.bpf.c

  1// SPDX-License-Identifier: GPL-2.0
  2/* Copyright (c) 2024 Tatsuyuki Ishi
  3 */
  4
  5#include "vmlinux.h"
  6#include "hid_bpf.h"
  7#include "hid_bpf_helpers.h"
  8#include <bpf/bpf_tracing.h>
  9
 10#define VID_HOLTEK	0x04D9
 11#define PID_MD770	0x0339
 12#define RDESC_SIZE	203
 13
 14HID_BPF_CONFIG(
 15	HID_DEVICE(BUS_USB, HID_GROUP_GENERIC, VID_HOLTEK, PID_MD770)
 16);
 17
 18/*
 19 * The Mistel MD770 keyboard reports the first 6 simultaneous key presses
 20 * through the first interface, and anything beyond that through a second
 21 * interface. Unfortunately, the second interface's report descriptor has an
 22 * error, causing events to be malformed and ignored. This HID-BPF driver
 23 * fixes the descriptor to allow NKRO to work again.
 24 *
 25 * For reference, this is the original report descriptor:
 26 *
 27 * 0x05, 0x01,        // Usage Page (Generic Desktop)        0
 28 * 0x09, 0x80,        // Usage (System Control)              2
 29 * 0xa1, 0x01,        // Collection (Application)            4
 30 * 0x85, 0x01,        //  Report ID (1)                      6
 31 * 0x19, 0x81,        //  Usage Minimum (129)                8
 32 * 0x29, 0x83,        //  Usage Maximum (131)                10
 33 * 0x15, 0x00,        //  Logical Minimum (0)                12
 34 * 0x25, 0x01,        //  Logical Maximum (1)                14
 35 * 0x95, 0x03,        //  Report Count (3)                   16
 36 * 0x75, 0x01,        //  Report Size (1)                    18
 37 * 0x81, 0x02,        //  Input (Data,Var,Abs)               20
 38 * 0x95, 0x01,        //  Report Count (1)                   22
 39 * 0x75, 0x05,        //  Report Size (5)                    24
 40 * 0x81, 0x01,        //  Input (Cnst,Arr,Abs)               26
 41 * 0xc0,              // End Collection                      28
 42 * 0x05, 0x0c,        // Usage Page (Consumer Devices)       29
 43 * 0x09, 0x01,        // Usage (Consumer Control)            31
 44 * 0xa1, 0x01,        // Collection (Application)            33
 45 * 0x85, 0x02,        //  Report ID (2)                      35
 46 * 0x15, 0x00,        //  Logical Minimum (0)                37
 47 * 0x25, 0x01,        //  Logical Maximum (1)                39
 48 * 0x95, 0x12,        //  Report Count (18)                  41
 49 * 0x75, 0x01,        //  Report Size (1)                    43
 50 * 0x0a, 0x83, 0x01,  //  Usage (AL Consumer Control Config) 45
 51 * 0x0a, 0x8a, 0x01,  //  Usage (AL Email Reader)            48
 52 * 0x0a, 0x92, 0x01,  //  Usage (AL Calculator)              51
 53 * 0x0a, 0x94, 0x01,  //  Usage (AL Local Machine Browser)   54
 54 * 0x09, 0xcd,        //  Usage (Play/Pause)                 57
 55 * 0x09, 0xb7,        //  Usage (Stop)                       59
 56 * 0x09, 0xb6,        //  Usage (Scan Previous Track)        61
 57 * 0x09, 0xb5,        //  Usage (Scan Next Track)            63
 58 * 0x09, 0xe2,        //  Usage (Mute)                       65
 59 * 0x09, 0xea,        //  Usage (Volume Down)                67
 60 * 0x09, 0xe9,        //  Usage (Volume Up)                  69
 61 * 0x0a, 0x21, 0x02,  //  Usage (AC Search)                  71
 62 * 0x0a, 0x23, 0x02,  //  Usage (AC Home)                    74
 63 * 0x0a, 0x24, 0x02,  //  Usage (AC Back)                    77
 64 * 0x0a, 0x25, 0x02,  //  Usage (AC Forward)                 80
 65 * 0x0a, 0x26, 0x02,  //  Usage (AC Stop)                    83
 66 * 0x0a, 0x27, 0x02,  //  Usage (AC Refresh)                 86
 67 * 0x0a, 0x2a, 0x02,  //  Usage (AC Bookmarks)               89
 68 * 0x81, 0x02,        //  Input (Data,Var,Abs)               92
 69 * 0x95, 0x01,        //  Report Count (1)                   94
 70 * 0x75, 0x0e,        //  Report Size (14)                   96
 71 * 0x81, 0x01,        //  Input (Cnst,Arr,Abs)               98
 72 * 0xc0,              // End Collection                      100
 73 * 0x05, 0x01,        // Usage Page (Generic Desktop)        101
 74 * 0x09, 0x02,        // Usage (Mouse)                       103
 75 * 0xa1, 0x01,        // Collection (Application)            105
 76 * 0x09, 0x01,        //  Usage (Pointer)                    107
 77 * 0xa1, 0x00,        //  Collection (Physical)              109
 78 * 0x85, 0x03,        //   Report ID (3)                     111
 79 * 0x05, 0x09,        //   Usage Page (Button)               113
 80 * 0x19, 0x01,        //   Usage Minimum (1)                 115
 81 * 0x29, 0x08,        //   Usage Maximum (8)                 117
 82 * 0x15, 0x00,        //   Logical Minimum (0)               119
 83 * 0x25, 0x01,        //   Logical Maximum (1)               121
 84 * 0x75, 0x01,        //   Report Size (1)                   123
 85 * 0x95, 0x08,        //   Report Count (8)                  125
 86 * 0x81, 0x02,        //   Input (Data,Var,Abs)              127
 87 * 0x05, 0x01,        //   Usage Page (Generic Desktop)      129
 88 * 0x09, 0x30,        //   Usage (X)                         131
 89 * 0x09, 0x31,        //   Usage (Y)                         133
 90 * 0x16, 0x01, 0x80,  //   Logical Minimum (-32767)          135
 91 * 0x26, 0xff, 0x7f,  //   Logical Maximum (32767)           138
 92 * 0x75, 0x10,        //   Report Size (16)                  141
 93 * 0x95, 0x02,        //   Report Count (2)                  143
 94 * 0x81, 0x06,        //   Input (Data,Var,Rel)              145
 95 * 0x09, 0x38,        //   Usage (Wheel)                     147
 96 * 0x15, 0x81,        //   Logical Minimum (-127)            149
 97 * 0x25, 0x7f,        //   Logical Maximum (127)             151
 98 * 0x75, 0x08,        //   Report Size (8)                   153
 99 * 0x95, 0x01,        //   Report Count (1)                  155
100 * 0x81, 0x06,        //   Input (Data,Var,Rel)              157
101 * 0x05, 0x0c,        //   Usage Page (Consumer Devices)     159
102 * 0x0a, 0x38, 0x02,  //   Usage (AC Pan)                    161
103 * 0x95, 0x01,        //   Report Count (1)                  164
104 * 0x81, 0x06,        //   Input (Data,Var,Rel)              166
105 * 0xc0,              //  End Collection                     168
106 * 0xc0,              // End Collection                      169
107 * 0x05, 0x01,        // Usage Page (Generic Desktop)        170
108 * 0x09, 0x06,        // Usage (Keyboard)                    172
109 * 0xa1, 0x01,        // Collection (Application)            174
110 * 0x85, 0x04,        //  Report ID (4)                      176
111 * 0x05, 0x07,        //  Usage Page (Keyboard)              178
112 * 0x95, 0x01,        //  Report Count (1)                   180
113 * 0x75, 0x08,        //  Report Size (8)                    182
114 * 0x81, 0x03,        //  Input (Cnst,Var,Abs)               184
115 * 0x95, 0xe8,        //  Report Count (232)                 186
116 * 0x75, 0x01,        //  Report Size (1)                    188
117 * 0x15, 0x00,        //  Logical Minimum (0)                190
118 * 0x25, 0x01,        //  Logical Maximum (1)                192
119 * 0x05, 0x07,        //  Usage Page (Keyboard)              194
120 * 0x19, 0x00,        //  Usage Minimum (0)                  196
121 * 0x29, 0xe7,        //  Usage Maximum (231)                198
122 * 0x81, 0x00,        //  Input (Data,Arr,Abs)               200  <- change to 0x81, 0x02 (Data,Var,Abs)
123 * 0xc0,              // End Collection                      202
124 */
125
126SEC(HID_BPF_RDESC_FIXUP)
127int BPF_PROG(hid_rdesc_fixup_mistel_md770, struct hid_bpf_ctx *hctx)
128{
129	__u8 *data = hid_bpf_get_data(hctx, 0, HID_MAX_DESCRIPTOR_SIZE);
130
131	if (!data)
132		return 0; /* EPERM check */
133
134	if (data[201] == 0x00)
135		data[201] = 0x02;
136
137	return 0;
138}
139
140HID_BPF_OPS(mistel_md770) = {
141	.hid_rdesc_fixup = (void *)hid_rdesc_fixup_mistel_md770,
142};
143
144SEC("syscall")
145int probe(struct hid_bpf_probe_args *ctx)
146{
147	ctx->retval = ctx->rdesc_size != RDESC_SIZE;
148	if (ctx->retval)
149		ctx->retval = -EINVAL;
150
151	return 0;
152}
153
154char _license[] SEC("license") = "GPL";