Blame view

kernel/linux-rt-4.4.41/drivers/hid/hid-plantronics.c 4.5 KB
5113f6f70   김현기   kernel add
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
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
  /*
   *  Plantronics USB HID Driver
   *
   *  Copyright (c) 2014 JD Cole <jd.cole@plantronics.com>
   *  Copyright (c) 2015 Terry Junge <terry.junge@plantronics.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 2 of the License, or (at your option)
   * any later version.
   */
  
  #include "hid-ids.h"
  
  #include <linux/hid.h>
  #include <linux/module.h>
  
  #define PLT_HID_1_0_PAGE	0xffa00000
  #define PLT_HID_2_0_PAGE	0xffa20000
  
  #define PLT_BASIC_TELEPHONY	0x0003
  #define PLT_BASIC_EXCEPTION	0x0005
  
  #define PLT_VOL_UP		0x00b1
  #define PLT_VOL_DOWN		0x00b2
  
  #define PLT1_VOL_UP		(PLT_HID_1_0_PAGE | PLT_VOL_UP)
  #define PLT1_VOL_DOWN		(PLT_HID_1_0_PAGE | PLT_VOL_DOWN)
  #define PLT2_VOL_UP		(PLT_HID_2_0_PAGE | PLT_VOL_UP)
  #define PLT2_VOL_DOWN		(PLT_HID_2_0_PAGE | PLT_VOL_DOWN)
  
  #define PLT_DA60		0xda60
  #define PLT_BT300_MIN		0x0413
  #define PLT_BT300_MAX		0x0418
  
  
  #define PLT_ALLOW_CONSUMER (field->application == HID_CP_CONSUMERCONTROL && \
  			    (usage->hid & HID_USAGE_PAGE) == HID_UP_CONSUMER)
  
  static int plantronics_input_mapping(struct hid_device *hdev,
  				     struct hid_input *hi,
  				     struct hid_field *field,
  				     struct hid_usage *usage,
  				     unsigned long **bit, int *max)
  {
  	unsigned short mapped_key;
  	unsigned long plt_type = (unsigned long)hid_get_drvdata(hdev);
  
  	/* handle volume up/down mapping */
  	/* non-standard types or multi-HID interfaces - plt_type is PID */
  	if (!(plt_type & HID_USAGE_PAGE)) {
  		switch (plt_type) {
  		case PLT_DA60:
  			if (PLT_ALLOW_CONSUMER)
  				goto defaulted;
  			goto ignored;
  		default:
  			if (PLT_ALLOW_CONSUMER)
  				goto defaulted;
  		}
  	}
  	/* handle standard types - plt_type is 0xffa0uuuu or 0xffa2uuuu */
  	/* 'basic telephony compliant' - allow default consumer page map */
  	else if ((plt_type & HID_USAGE) >= PLT_BASIC_TELEPHONY &&
  		 (plt_type & HID_USAGE) != PLT_BASIC_EXCEPTION) {
  		if (PLT_ALLOW_CONSUMER)
  			goto defaulted;
  	}
  	/* not 'basic telephony' - apply legacy mapping */
  	/* only map if the field is in the device's primary vendor page */
  	else if (!((field->application ^ plt_type) & HID_USAGE_PAGE)) {
  		switch (usage->hid) {
  		case PLT1_VOL_UP:
  		case PLT2_VOL_UP:
  			mapped_key = KEY_VOLUMEUP;
  			goto mapped;
  		case PLT1_VOL_DOWN:
  		case PLT2_VOL_DOWN:
  			mapped_key = KEY_VOLUMEDOWN;
  			goto mapped;
  		}
  	}
  
  /*
   * Future mapping of call control or other usages,
   * if and when keys are defined would go here
   * otherwise, ignore everything else that was not mapped
   */
  
  ignored:
  	return -1;
  
  defaulted:
  	hid_dbg(hdev, "usage: %08x (appl: %08x) - defaulted
  ",
  		usage->hid, field->application);
  	return 0;
  
  mapped:
  	hid_map_usage_clear(hi, usage, bit, max, EV_KEY, mapped_key);
  	hid_dbg(hdev, "usage: %08x (appl: %08x) - mapped to key %d
  ",
  		usage->hid, field->application, mapped_key);
  	return 1;
  }
  
  static unsigned long plantronics_device_type(struct hid_device *hdev)
  {
  	unsigned i, col_page;
  	unsigned long plt_type = hdev->product;
  
  	/* multi-HID interfaces? - plt_type is PID */
  	if (plt_type >= PLT_BT300_MIN && plt_type <= PLT_BT300_MAX)
  		goto exit;
  
  	/* determine primary vendor page */
  	for (i = 0; i < hdev->maxcollection; i++) {
  		col_page = hdev->collection[i].usage & HID_USAGE_PAGE;
  		if (col_page == PLT_HID_2_0_PAGE) {
  			plt_type = hdev->collection[i].usage;
  			break;
  		}
  		if (col_page == PLT_HID_1_0_PAGE)
  			plt_type = hdev->collection[i].usage;
  	}
  
  exit:
  	hid_dbg(hdev, "plt_type decoded as: %08lx
  ", plt_type);
  	return plt_type;
  }
  
  static int plantronics_probe(struct hid_device *hdev,
  			     const struct hid_device_id *id)
  {
  	int ret;
  
  	ret = hid_parse(hdev);
  	if (ret) {
  		hid_err(hdev, "parse failed
  ");
  		goto err;
  	}
  
  	hid_set_drvdata(hdev, (void *)plantronics_device_type(hdev));
  
  	ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT |
  		HID_CONNECT_HIDINPUT_FORCE | HID_CONNECT_HIDDEV_FORCE);
  	if (ret)
  		hid_err(hdev, "hw start failed
  ");
  
  err:
  	return ret;
  }
  
  static const struct hid_device_id plantronics_devices[] = {
  	{ HID_USB_DEVICE(USB_VENDOR_ID_PLANTRONICS, HID_ANY_ID) },
  	{ }
  };
  MODULE_DEVICE_TABLE(hid, plantronics_devices);
  
  static struct hid_driver plantronics_driver = {
  	.name = "plantronics",
  	.id_table = plantronics_devices,
  	.input_mapping = plantronics_input_mapping,
  	.probe = plantronics_probe,
  };
  module_hid_driver(plantronics_driver);
  
  MODULE_AUTHOR("JD Cole <jd.cole@plantronics.com>");
  MODULE_AUTHOR("Terry Junge <terry.junge@plantronics.com>");
  MODULE_DESCRIPTION("Plantronics USB HID Driver");
  MODULE_LICENSE("GPL");