diff --git a/arch/arm64/kernel/vmlinux.lds.S b/arch/arm64/kernel/vmlinux.lds.S index 69e7c8d4a..6bdc118dd 100644 --- a/arch/arm64/kernel/vmlinux.lds.S +++ b/arch/arm64/kernel/vmlinux.lds.S @@ -176,6 +176,15 @@ SECTIONS INIT_RAM_FS *(.init.rodata.* .init.bss) /* from the EFI stub */ } + +#ifdef CONFIG_DRIVERS_HDF + .init.hdf_table : { + _hdf_drivers_start = .; + *(.hdf.driver) + _hdf_drivers_end = .; + } +#endif + .exit.data : { ARM_EXIT_KEEP(EXIT_DATA) } diff --git a/arch/arm/kernel/vmlinux.lds.S b/arch/arm/kernel/vmlinux.lds.S index 23150c0f0..2780470c5 100644 --- a/arch/arm/kernel/vmlinux.lds.S +++ b/arch/arm/kernel/vmlinux.lds.S @@ -121,6 +121,14 @@ SECTIONS __pv_table_end = .; } +#ifdef CONFIG_DRIVERS_HDF + .init.hdf_table : { + _hdf_drivers_start = .; + *(.hdf.driver) + _hdf_drivers_end = .; + } +#endif + INIT_DATA_SECTION(16) .exit.data : { diff --git a/drivers/Kconfig b/drivers/Kconfig index ab4d43923..70fade369 100644 --- a/drivers/Kconfig +++ b/drivers/Kconfig @@ -217,6 +217,8 @@ source "drivers/visorbus/Kconfig" source "drivers/siox/Kconfig" +source "drivers/hdf/khdf/Kconfig" + source "drivers/slimbus/Kconfig" endmenu diff --git a/drivers/Makefile b/drivers/Makefile index 578f469f7..f4aae6a3a 100644 --- a/drivers/Makefile +++ b/drivers/Makefile @@ -185,4 +185,5 @@ obj-$(CONFIG_TEE) += tee/ obj-$(CONFIG_MULTIPLEXER) += mux/ obj-$(CONFIG_UNISYS_VISORBUS) += visorbus/ obj-$(CONFIG_SIOX) += siox/ +obj-$(CONFIG_DRIVERS_HDF) += hdf/ obj-$(CONFIG_GNSS) += gnss/ diff --git a/drivers/hdf/Makefile b/drivers/hdf/Makefile new file mode 100644 index 000000000..01ce6ab52 --- /dev/null +++ b/drivers/hdf/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_DRIVERS_HDF) += khdf/ diff --git a/drivers/hid/Makefile b/drivers/hid/Makefile index bd7ac53b7..d7efd1e3d 100644 --- a/drivers/hid/Makefile +++ b/drivers/hid/Makefile @@ -2,6 +2,15 @@ # # Makefile for the HID driver # +HDF_ROOT_DIR = -Idrivers/hdf +ccflags-$(CONFIG_DRIVERS_HDF_INPUT) += $(HDF_ROOT_DIR)/framework/model/input/driver \ + $(HDF_ROOT_DIR)/framework/include/core \ + $(HDF_ROOT_DIR)/framework/core/common/include/host \ + $(HDF_ROOT_DIR)/framework/include/utils \ + $(HDF_ROOT_DIR)/framework/include/osal \ + $(HDF_ROOT_DIR)/framework/ability/sbuf/include \ + $(HDF_ROOT_DIR)/khdf/osal/include \ + -I../../../../../third_party/FreeBSD/sys/dev/evdev hid-y := hid-core.o hid-input.o hid-quirks.o hid-$(CONFIG_DEBUG_FS) += hid-debug.o diff --git a/drivers/hid/hid-core.c b/drivers/hid/hid-core.c index bde5cef32..1cf2e9b9c 100644 --- a/drivers/hid/hid-core.c +++ b/drivers/hid/hid-core.c @@ -36,6 +36,9 @@ #include #include +#if defined(CONFIG_DRIVERS_HDF_INPUT) +#include "hdf_hid_adapter.h" +#endif #include "hid-ids.h" /* @@ -1340,6 +1343,11 @@ static void hid_process_event(struct hid_device *hid, struct hid_field *field, hidinput_hid_event(hid, field, usage, value); if (hid->claimed & HID_CLAIMED_HIDDEV && interrupt && hid->hiddev_hid_event) hid->hiddev_hid_event(hid, field, usage, value); +#if defined(CONFIG_DRIVERS_HDF_INPUT) + if (hid->input_dev) { + HidReportEvent(hid->input_dev, usage->type, usage->code, value); + } +#endif } /* @@ -1743,6 +1751,81 @@ static const struct device_attribute dev_attr_country = { .show = show_country, }; +#if defined(CONFIG_DRIVERS_HDF_INPUT) +static bool check_mouse(char *name) +{ + static char *option[]={"Mouse", "mouse", "MOUSE", "Razer"}; + for (int i = 0; i < 4; i++) { + if (strstr(name, option[i])) + return true; + } + return false; +} +static bool check_kbd(char *name) +{ + static char *option[]={"Keyboard", "keyboard"}; + for (int i = 0; i < 2; i++) { + if (strstr(name, option[i])) + return true; + } + return false; +} +static bool check_rocker(char *name) +{ + static char *option[]={"Thrustmaster"}; + for (int i = 0; i < 1; i++) { + if (strstr(name, option[i])) + return true; + } + return false; +} +static bool check_encoder(char *name) +{ + if (strcmp(name, "Wired KeyBoard") == 0) { + return true; + } + return false; +} +static bool check_trackball(char *name) +{ + static char *option[]={"Trackball"}; + for (int i = 0; i < 1; i++) { + if (strstr(name, option[i])) + return true; + } + return false; +} +static void notify_connect_event(struct hid_device *hdev) +{ + bool check; + int type = -1; + HidInfo *dev = (HidInfo *)kmalloc(sizeof(HidInfo), GFP_KERNEL); + if (dev == NULL) { + printk("%s: malloc failed", __func__); + return; + } + type = check_mouse(hdev->name)?HID_TYPE_MOUSE:type; + type = check_kbd(hdev->name)?HID_TYPE_KEYBOARD:type; + type = check_rocker(hdev->name)?HID_TYPE_ROCKER:type; + type = check_encoder(hdev->name)?HID_TYPE_ENCODER:type; + type = check_trackball(hdev->name)?HID_TYPE_TRACKBALL:type; + if ( type < 0) { + kfree(dev); + dev = NULL; + return; + } + + dev->devType = type; + dev->devName = hdev->name; + hdev->input_dev = HidRegisterHdfInputDev(dev); + if (hdev->input_dev == NULL) { + printk("%s: RegisterInputDevice failed\n", __func__); + } + kfree(dev); + dev = NULL; +} +#endif + int hid_connect(struct hid_device *hdev, unsigned int connect_mask) { static const char *types[] = { "Device", "Pointer", "Mouse", "Device", @@ -1832,6 +1915,9 @@ int hid_connect(struct hid_device *hdev, unsigned int connect_mask) hid_info(hdev, "%s: %s HID v%x.%02x %s [%s] on %s\n", buf, bus, hdev->version >> 8, hdev->version & 0xff, type, hdev->name, hdev->phys); +#if defined(CONFIG_DRIVERS_HDF_INPUT) + notify_connect_event(hdev); +#endif return 0; } @@ -1847,6 +1933,10 @@ void hid_disconnect(struct hid_device *hdev) if (hdev->claimed & HID_CLAIMED_HIDRAW) hidraw_disconnect(hdev); hdev->claimed = 0; +#if defined(CONFIG_DRIVERS_HDF_INPUT) + if (hdev->input_dev) + HidUnregisterHdfInputDev(hdev->input_dev); +#endif } EXPORT_SYMBOL_GPL(hid_disconnect); @@ -1931,6 +2021,11 @@ EXPORT_SYMBOL_GPL(hid_hw_open); */ void hid_hw_close(struct hid_device *hdev) { +#if defined(CONFIG_DRIVERS_HDF_INPUT) + if (hdev->input_dev) { + return; + } +#endif mutex_lock(&hdev->ll_open_lock); if (!--hdev->ll_open_count) hdev->ll_driver->close(hdev); diff --git a/drivers/hid/hid-input.c b/drivers/hid/hid-input.c index 11bd2ca22..a5d0d6c19 100644 --- a/drivers/hid/hid-input.c +++ b/drivers/hid/hid-input.c @@ -32,6 +32,10 @@ #include #include +#if defined(CONFIG_DRIVERS_HDF_INPUT) +#include "hdf_hid_adapter.h" +#endif + #include "hid-ids.h" #define unk KEY_UNKNOWN @@ -1365,7 +1369,15 @@ void hidinput_report_event(struct hid_device *hid, struct hid_report *report) return; list_for_each_entry(hidinput, &hid->inputs, list) +#if defined(CONFIG_DRIVERS_HDF_INPUT) + { +#endif input_sync(hidinput->input); +#if defined(CONFIG_DRIVERS_HDF_INPUT) + if(hid->input_dev) + HidReportEvent(hid->input_dev, EV_SYN, SYN_REPORT, 0); + } +#endif } EXPORT_SYMBOL_GPL(hidinput_report_event); @@ -1729,6 +1741,41 @@ static inline void hidinput_configure_usages(struct hid_input *hidinput, report->field[i]->usage + j); } +#if defined(CONFIG_DRIVERS_HDF_INPUT) +static void transfer_info(struct input_dev *dev) +{ + HidInfo *info = (HidInfo *)kmalloc(sizeof(HidInfo),GFP_KERNEL); + if (info == NULL) { + printk("%s: malloc failed\n",__func__); + return; + } + info->devName = dev->name; + memcpy(info->devProp, dev->propbit, sizeof(unsigned long) * BITS_TO_LONGS(INPUT_PROP_CNT)); + memcpy(info->eventType, dev->evbit, sizeof(unsigned long) * BITS_TO_LONGS(EV_CNT)); + memcpy(info->keyCode, dev->keybit, sizeof(unsigned long) * BITS_TO_LONGS(KEY_CNT)); + memcpy(info->relCode, dev->relbit, sizeof(unsigned long) * BITS_TO_LONGS(REL_CNT)); + memcpy(info->absCode, dev->absbit, sizeof(unsigned long) * BITS_TO_LONGS(ABS_CNT)); + memcpy(info->miscCode, dev->mscbit, sizeof(unsigned long) * BITS_TO_LONGS(MSC_CNT)); + memcpy(info->ledCode, dev->ledbit, sizeof(unsigned long) * BITS_TO_LONGS(LED_CNT)); + memcpy(info->soundCode, dev->sndbit, sizeof(unsigned long) * BITS_TO_LONGS(SND_CNT)); + memcpy(info->forceCode, dev->ffbit, sizeof(unsigned long) * BITS_TO_LONGS(FF_CNT)); + memcpy(info->switchCode, dev->swbit, sizeof(unsigned long) * BITS_TO_LONGS(SW_CNT)); + for (int i = 0; i < BITS_TO_LONGS(ABS_CNT); i++) { + if (dev->absbit[i] != 0) { + memcpy(info->axisInfo, dev->absinfo, sizeof(struct input_absinfo) * ABS_CNT); + break; + } + } + info->bustype = dev->id.bustype; + info->vendor = dev->id.vendor; + info->product = dev->id.product; + info->version = dev->id.version; + SendInfoToHdf(info); + kfree(info); + info = NULL; +} +#endif + /* * Register the input device; print a message. * Configure the input layer interface @@ -1811,7 +1858,9 @@ int hidinput_connect(struct hid_device *hid, unsigned int force) hidinput_cleanup_hidinput(hid, hidinput); continue; } - +#if defined(CONFIG_DRIVERS_HDF_INPUT) + transfer_info(hidinput->input); +#endif if (input_register_device(hidinput->input)) goto out_unwind; hidinput->registered = true; diff --git a/include/linux/hid.h b/include/linux/hid.h index a46b6832b..c61a17de5 100644 --- a/include/linux/hid.h +++ b/include/linux/hid.h @@ -621,6 +621,7 @@ struct hid_device { /* device report descriptor */ struct list_head debug_list; spinlock_t debug_list_lock; wait_queue_head_t debug_wait; + void *input_dev; }; #define to_hid_device(pdev) \ -- 2.25.1