drivers/hid/hid-cmedia.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * HID driver for CMedia CM6533 audio jack controls
   4  *
   5  * Copyright (C) 2015 Ben Chen <ben_chen@bizlinktech.com>
   6  */
   7
   8 #include <linux/device.h>
   9 #include <linux/hid.h>
  10 #include <linux/module.h>
  11 #include "hid-ids.h"
  12
  13 MODULE_AUTHOR("Ben Chen");
  14 MODULE_DESCRIPTION("CM6533 HID jack controls");
  15 MODULE_LICENSE("GPL");
  16
  17 #define CM6533_JD_TYPE_COUNT      1
  18 #define CM6533_JD_RAWEV_LEN      16
  19 #define CM6533_JD_SFX_OFFSET      8
  20
  21 /*
  22 *
  23 *CM6533 audio jack HID raw events:
  24 *
  25 *Plug in:
  26 *01000600 002083xx 080008c0 10000000
  27 *about 3 seconds later...
  28 *01000a00 002083xx 08000380 10000000
  29 *01000600 002083xx 08000380 10000000
  30 *
  31 *Plug out:
  32 *01000400 002083xx 080008c0 x0000000
  33 */
  34
  35 static const u8 ji_sfx[] = { 0x08, 0x00, 0x08, 0xc0 };
  36 static const u8 ji_in[]  = { 0x01, 0x00, 0x06, 0x00 };
  37 static const u8 ji_out[] = { 0x01, 0x00, 0x04, 0x00 };
  38
  39 static int jack_switch_types[CM6533_JD_TYPE_COUNT] = {
  40         SW_HEADPHONE_INSERT,
  41 };
  42
  43 struct cmhid {
  44         struct input_dev *input_dev;
  45         struct hid_device *hid;
  46         unsigned short switch_map[CM6533_JD_TYPE_COUNT];
  47 };
  48
  49 static void hp_ev(struct hid_device *hid, struct cmhid *cm, int value)
  50 {
  51         input_report_switch(cm->input_dev, SW_HEADPHONE_INSERT, value);
  52         input_sync(cm->input_dev);
  53 }
  54
  55 static int cmhid_raw_event(struct hid_device *hid, struct hid_report *report,
  56          u8 *data, int len)
  57 {
  58         struct cmhid *cm = hid_get_drvdata(hid);
  59
  60         if (len != CM6533_JD_RAWEV_LEN)
  61                 goto out;
  62         if (memcmp(data+CM6533_JD_SFX_OFFSET, ji_sfx, sizeof(ji_sfx)))
  63                 goto out;
  64
  65         if (!memcmp(data, ji_out, sizeof(ji_out))) {
  66                 hp_ev(hid, cm, 0);
  67                 goto out;
  68         }
  69         if (!memcmp(data, ji_in, sizeof(ji_in))) {
  70                 hp_ev(hid, cm, 1);
  71                 goto out;
  72         }
  73
  74 out:
  75         return 0;
  76 }
  77
  78 static int cmhid_input_configured(struct hid_device *hid,
  79                 struct hid_input *hidinput)
  80 {
  81         struct input_dev *input_dev = hidinput->input;
  82         struct cmhid *cm = hid_get_drvdata(hid);
  83         int i;
  84
  85         cm->input_dev = input_dev;
  86         memcpy(cm->switch_map, jack_switch_types, sizeof(cm->switch_map));
  87         input_dev->evbit[0] = BIT(EV_SW);
  88         for (i = 0; i < CM6533_JD_TYPE_COUNT; i++)
  89                 input_set_capability(cm->input_dev,
  90                                 EV_SW, jack_switch_types[i]);
  91         return 0;
  92 }
  93
  94 static int cmhid_input_mapping(struct hid_device *hid,
  95                 struct hid_input *hi, struct hid_field *field,
  96                 struct hid_usage *usage, unsigned long **bit, int *max)
  97 {
  98         return -1;
  99 }
 100
 101 static int cmhid_probe(struct hid_device *hid, const struct hid_device_id *id)
 102 {
 103         int ret;
 104         struct cmhid *cm;
 105
 106         cm = kzalloc(sizeof(struct cmhid), GFP_KERNEL);
 107         if (!cm) {
 108                 ret = -ENOMEM;
 109                 goto allocfail;
 110         }
 111
 112         cm->hid = hid;
 113
 114         hid->quirks |= HID_QUIRK_HIDINPUT_FORCE;
 115         hid_set_drvdata(hid, cm);
 116
 117         ret = hid_parse(hid);
 118         if (ret) {
 119                 hid_err(hid, "parse failed\n");
 120                 goto fail;
 121         }
 122
 123         ret = hid_hw_start(hid, HID_CONNECT_DEFAULT | HID_CONNECT_HIDDEV_FORCE);
 124         if (ret) {
 125                 hid_err(hid, "hw start failed\n");
 126                 goto fail;
 127         }
 128
 129         return 0;
 130 fail:
 131         kfree(cm);
 132 allocfail:
 133         return ret;
 134 }
 135
 136 static void cmhid_remove(struct hid_device *hid)
 137 {
 138         struct cmhid *cm = hid_get_drvdata(hid);
 139
 140         hid_hw_stop(hid);
 141         kfree(cm);
 142 }
 143
 144 static const struct hid_device_id cmhid_devices[] = {
 145         { HID_USB_DEVICE(USB_VENDOR_ID_CMEDIA, USB_DEVICE_ID_CM6533) },
 146         { }
 147 };
 148 MODULE_DEVICE_TABLE(hid, cmhid_devices);
 149
 150 static struct hid_driver cmhid_driver = {
 151         .name = "cm6533_jd",
 152         .id_table = cmhid_devices,
 153         .raw_event = cmhid_raw_event,
 154         .input_configured = cmhid_input_configured,
 155         .probe = cmhid_probe,
 156         .remove = cmhid_remove,
 157         .input_mapping = cmhid_input_mapping,
 158 };
 159 module_hid_driver(cmhid_driver);
 160