xref: /OK3568_Linux_fs/kernel/drivers/hid/hid-prodikeys.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  *  HID driver for the Prodikeys PC-MIDI Keyboard
4*4882a593Smuzhiyun  *  providing midi & extra multimedia keys functionality
5*4882a593Smuzhiyun  *
6*4882a593Smuzhiyun  *  Copyright (c) 2009 Don Prince <dhprince.devel@yahoo.co.uk>
7*4882a593Smuzhiyun  *
8*4882a593Smuzhiyun  *  Controls for Octave Shift Up/Down, Channel, and
9*4882a593Smuzhiyun  *  Sustain Duration available via sysfs.
10*4882a593Smuzhiyun  */
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun /*
13*4882a593Smuzhiyun  */
14*4882a593Smuzhiyun 
15*4882a593Smuzhiyun #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
16*4882a593Smuzhiyun 
17*4882a593Smuzhiyun #include <linux/device.h>
18*4882a593Smuzhiyun #include <linux/module.h>
19*4882a593Smuzhiyun #include <linux/usb.h>
20*4882a593Smuzhiyun #include <linux/mutex.h>
21*4882a593Smuzhiyun #include <linux/hid.h>
22*4882a593Smuzhiyun #include <sound/core.h>
23*4882a593Smuzhiyun #include <sound/initval.h>
24*4882a593Smuzhiyun #include <sound/rawmidi.h>
25*4882a593Smuzhiyun #include "hid-ids.h"
26*4882a593Smuzhiyun 
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun #define pk_debug(format, arg...) \
29*4882a593Smuzhiyun 	pr_debug("hid-prodikeys: " format "\n" , ## arg)
30*4882a593Smuzhiyun #define pk_error(format, arg...) \
31*4882a593Smuzhiyun 	pr_err("hid-prodikeys: " format "\n" , ## arg)
32*4882a593Smuzhiyun 
33*4882a593Smuzhiyun struct pcmidi_snd;
34*4882a593Smuzhiyun 
35*4882a593Smuzhiyun struct pk_device {
36*4882a593Smuzhiyun 	unsigned long		quirks;
37*4882a593Smuzhiyun 
38*4882a593Smuzhiyun 	struct hid_device	*hdev;
39*4882a593Smuzhiyun 	struct pcmidi_snd	*pm; /* pcmidi device context */
40*4882a593Smuzhiyun };
41*4882a593Smuzhiyun 
42*4882a593Smuzhiyun struct pcmidi_sustain {
43*4882a593Smuzhiyun 	unsigned long		in_use;
44*4882a593Smuzhiyun 	struct pcmidi_snd	*pm;
45*4882a593Smuzhiyun 	struct timer_list	timer;
46*4882a593Smuzhiyun 	unsigned char		status;
47*4882a593Smuzhiyun 	unsigned char		note;
48*4882a593Smuzhiyun 	unsigned char		velocity;
49*4882a593Smuzhiyun };
50*4882a593Smuzhiyun 
51*4882a593Smuzhiyun #define PCMIDI_SUSTAINED_MAX	32
52*4882a593Smuzhiyun struct pcmidi_snd {
53*4882a593Smuzhiyun 	struct pk_device		*pk;
54*4882a593Smuzhiyun 	unsigned short			ifnum;
55*4882a593Smuzhiyun 	struct hid_report		*pcmidi_report6;
56*4882a593Smuzhiyun 	struct input_dev		*input_ep82;
57*4882a593Smuzhiyun 	unsigned short			midi_mode;
58*4882a593Smuzhiyun 	unsigned short			midi_sustain_mode;
59*4882a593Smuzhiyun 	unsigned short			midi_sustain;
60*4882a593Smuzhiyun 	unsigned short			midi_channel;
61*4882a593Smuzhiyun 	short				midi_octave;
62*4882a593Smuzhiyun 	struct pcmidi_sustain		sustained_notes[PCMIDI_SUSTAINED_MAX];
63*4882a593Smuzhiyun 	unsigned short			fn_state;
64*4882a593Smuzhiyun 	unsigned short			last_key[24];
65*4882a593Smuzhiyun 	spinlock_t			rawmidi_in_lock;
66*4882a593Smuzhiyun 	struct snd_card			*card;
67*4882a593Smuzhiyun 	struct snd_rawmidi		*rwmidi;
68*4882a593Smuzhiyun 	struct snd_rawmidi_substream	*in_substream;
69*4882a593Smuzhiyun 	struct snd_rawmidi_substream	*out_substream;
70*4882a593Smuzhiyun 	unsigned long			in_triggered;
71*4882a593Smuzhiyun 	unsigned long			out_active;
72*4882a593Smuzhiyun };
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun #define PK_QUIRK_NOGET	0x00010000
75*4882a593Smuzhiyun #define PCMIDI_MIDDLE_C 60
76*4882a593Smuzhiyun #define PCMIDI_CHANNEL_MIN 0
77*4882a593Smuzhiyun #define PCMIDI_CHANNEL_MAX 15
78*4882a593Smuzhiyun #define PCMIDI_OCTAVE_MIN (-2)
79*4882a593Smuzhiyun #define PCMIDI_OCTAVE_MAX 2
80*4882a593Smuzhiyun #define PCMIDI_SUSTAIN_MIN 0
81*4882a593Smuzhiyun #define PCMIDI_SUSTAIN_MAX 5000
82*4882a593Smuzhiyun 
83*4882a593Smuzhiyun static const char shortname[] = "PC-MIDI";
84*4882a593Smuzhiyun static const char longname[] = "Prodikeys PC-MIDI Keyboard";
85*4882a593Smuzhiyun 
86*4882a593Smuzhiyun static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;
87*4882a593Smuzhiyun static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;
88*4882a593Smuzhiyun static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
89*4882a593Smuzhiyun 
90*4882a593Smuzhiyun module_param_array(index, int, NULL, 0444);
91*4882a593Smuzhiyun module_param_array(id, charp, NULL, 0444);
92*4882a593Smuzhiyun module_param_array(enable, bool, NULL, 0444);
93*4882a593Smuzhiyun MODULE_PARM_DESC(index, "Index value for the PC-MIDI virtual audio driver");
94*4882a593Smuzhiyun MODULE_PARM_DESC(id, "ID string for the PC-MIDI virtual audio driver");
95*4882a593Smuzhiyun MODULE_PARM_DESC(enable, "Enable for the PC-MIDI virtual audio driver");
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun 
98*4882a593Smuzhiyun /* Output routine for the sysfs channel file */
show_channel(struct device * dev,struct device_attribute * attr,char * buf)99*4882a593Smuzhiyun static ssize_t show_channel(struct device *dev,
100*4882a593Smuzhiyun 	struct device_attribute *attr, char *buf)
101*4882a593Smuzhiyun {
102*4882a593Smuzhiyun 	struct hid_device *hdev = to_hid_device(dev);
103*4882a593Smuzhiyun 	struct pk_device *pk = hid_get_drvdata(hdev);
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun 	dbg_hid("pcmidi sysfs read channel=%u\n", pk->pm->midi_channel);
106*4882a593Smuzhiyun 
107*4882a593Smuzhiyun 	return sprintf(buf, "%u (min:%u, max:%u)\n", pk->pm->midi_channel,
108*4882a593Smuzhiyun 		PCMIDI_CHANNEL_MIN, PCMIDI_CHANNEL_MAX);
109*4882a593Smuzhiyun }
110*4882a593Smuzhiyun 
111*4882a593Smuzhiyun /* Input routine for the sysfs channel file */
store_channel(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)112*4882a593Smuzhiyun static ssize_t store_channel(struct device *dev,
113*4882a593Smuzhiyun 	struct device_attribute *attr, const char *buf, size_t count)
114*4882a593Smuzhiyun {
115*4882a593Smuzhiyun 	struct hid_device *hdev = to_hid_device(dev);
116*4882a593Smuzhiyun 	struct pk_device *pk = hid_get_drvdata(hdev);
117*4882a593Smuzhiyun 
118*4882a593Smuzhiyun 	unsigned channel = 0;
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun 	if (sscanf(buf, "%u", &channel) > 0 && channel <= PCMIDI_CHANNEL_MAX) {
121*4882a593Smuzhiyun 		dbg_hid("pcmidi sysfs write channel=%u\n", channel);
122*4882a593Smuzhiyun 		pk->pm->midi_channel = channel;
123*4882a593Smuzhiyun 		return strlen(buf);
124*4882a593Smuzhiyun 	}
125*4882a593Smuzhiyun 	return -EINVAL;
126*4882a593Smuzhiyun }
127*4882a593Smuzhiyun 
128*4882a593Smuzhiyun static DEVICE_ATTR(channel, S_IRUGO | S_IWUSR | S_IWGRP , show_channel,
129*4882a593Smuzhiyun 		store_channel);
130*4882a593Smuzhiyun 
131*4882a593Smuzhiyun static struct device_attribute *sysfs_device_attr_channel = {
132*4882a593Smuzhiyun 		&dev_attr_channel,
133*4882a593Smuzhiyun 		};
134*4882a593Smuzhiyun 
135*4882a593Smuzhiyun /* Output routine for the sysfs sustain file */
show_sustain(struct device * dev,struct device_attribute * attr,char * buf)136*4882a593Smuzhiyun static ssize_t show_sustain(struct device *dev,
137*4882a593Smuzhiyun  struct device_attribute *attr, char *buf)
138*4882a593Smuzhiyun {
139*4882a593Smuzhiyun 	struct hid_device *hdev = to_hid_device(dev);
140*4882a593Smuzhiyun 	struct pk_device *pk = hid_get_drvdata(hdev);
141*4882a593Smuzhiyun 
142*4882a593Smuzhiyun 	dbg_hid("pcmidi sysfs read sustain=%u\n", pk->pm->midi_sustain);
143*4882a593Smuzhiyun 
144*4882a593Smuzhiyun 	return sprintf(buf, "%u (off:%u, max:%u (ms))\n", pk->pm->midi_sustain,
145*4882a593Smuzhiyun 		PCMIDI_SUSTAIN_MIN, PCMIDI_SUSTAIN_MAX);
146*4882a593Smuzhiyun }
147*4882a593Smuzhiyun 
148*4882a593Smuzhiyun /* Input routine for the sysfs sustain file */
store_sustain(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)149*4882a593Smuzhiyun static ssize_t store_sustain(struct device *dev,
150*4882a593Smuzhiyun 	struct device_attribute *attr, const char *buf, size_t count)
151*4882a593Smuzhiyun {
152*4882a593Smuzhiyun 	struct hid_device *hdev = to_hid_device(dev);
153*4882a593Smuzhiyun 	struct pk_device *pk = hid_get_drvdata(hdev);
154*4882a593Smuzhiyun 
155*4882a593Smuzhiyun 	unsigned sustain = 0;
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun 	if (sscanf(buf, "%u", &sustain) > 0 && sustain <= PCMIDI_SUSTAIN_MAX) {
158*4882a593Smuzhiyun 		dbg_hid("pcmidi sysfs write sustain=%u\n", sustain);
159*4882a593Smuzhiyun 		pk->pm->midi_sustain = sustain;
160*4882a593Smuzhiyun 		pk->pm->midi_sustain_mode =
161*4882a593Smuzhiyun 			(0 == sustain || !pk->pm->midi_mode) ? 0 : 1;
162*4882a593Smuzhiyun 		return strlen(buf);
163*4882a593Smuzhiyun 	}
164*4882a593Smuzhiyun 	return -EINVAL;
165*4882a593Smuzhiyun }
166*4882a593Smuzhiyun 
167*4882a593Smuzhiyun static DEVICE_ATTR(sustain, S_IRUGO | S_IWUSR | S_IWGRP, show_sustain,
168*4882a593Smuzhiyun 		store_sustain);
169*4882a593Smuzhiyun 
170*4882a593Smuzhiyun static struct device_attribute *sysfs_device_attr_sustain = {
171*4882a593Smuzhiyun 		&dev_attr_sustain,
172*4882a593Smuzhiyun 		};
173*4882a593Smuzhiyun 
174*4882a593Smuzhiyun /* Output routine for the sysfs octave file */
show_octave(struct device * dev,struct device_attribute * attr,char * buf)175*4882a593Smuzhiyun static ssize_t show_octave(struct device *dev,
176*4882a593Smuzhiyun 	struct device_attribute *attr, char *buf)
177*4882a593Smuzhiyun {
178*4882a593Smuzhiyun 	struct hid_device *hdev = to_hid_device(dev);
179*4882a593Smuzhiyun 	struct pk_device *pk = hid_get_drvdata(hdev);
180*4882a593Smuzhiyun 
181*4882a593Smuzhiyun 	dbg_hid("pcmidi sysfs read octave=%d\n", pk->pm->midi_octave);
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun 	return sprintf(buf, "%d (min:%d, max:%d)\n", pk->pm->midi_octave,
184*4882a593Smuzhiyun 		PCMIDI_OCTAVE_MIN, PCMIDI_OCTAVE_MAX);
185*4882a593Smuzhiyun }
186*4882a593Smuzhiyun 
187*4882a593Smuzhiyun /* Input routine for the sysfs octave file */
store_octave(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)188*4882a593Smuzhiyun static ssize_t store_octave(struct device *dev,
189*4882a593Smuzhiyun 	struct device_attribute *attr, const char *buf, size_t count)
190*4882a593Smuzhiyun {
191*4882a593Smuzhiyun 	struct hid_device *hdev = to_hid_device(dev);
192*4882a593Smuzhiyun 	struct pk_device *pk = hid_get_drvdata(hdev);
193*4882a593Smuzhiyun 
194*4882a593Smuzhiyun 	int octave = 0;
195*4882a593Smuzhiyun 
196*4882a593Smuzhiyun 	if (sscanf(buf, "%d", &octave) > 0 &&
197*4882a593Smuzhiyun 		octave >= PCMIDI_OCTAVE_MIN && octave <= PCMIDI_OCTAVE_MAX) {
198*4882a593Smuzhiyun 		dbg_hid("pcmidi sysfs write octave=%d\n", octave);
199*4882a593Smuzhiyun 		pk->pm->midi_octave = octave;
200*4882a593Smuzhiyun 		return strlen(buf);
201*4882a593Smuzhiyun 	}
202*4882a593Smuzhiyun 	return -EINVAL;
203*4882a593Smuzhiyun }
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun static DEVICE_ATTR(octave, S_IRUGO | S_IWUSR | S_IWGRP, show_octave,
206*4882a593Smuzhiyun 		store_octave);
207*4882a593Smuzhiyun 
208*4882a593Smuzhiyun static struct device_attribute *sysfs_device_attr_octave = {
209*4882a593Smuzhiyun 		&dev_attr_octave,
210*4882a593Smuzhiyun 		};
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun 
pcmidi_send_note(struct pcmidi_snd * pm,unsigned char status,unsigned char note,unsigned char velocity)213*4882a593Smuzhiyun static void pcmidi_send_note(struct pcmidi_snd *pm,
214*4882a593Smuzhiyun 	unsigned char status, unsigned char note, unsigned char velocity)
215*4882a593Smuzhiyun {
216*4882a593Smuzhiyun 	unsigned long flags;
217*4882a593Smuzhiyun 	unsigned char buffer[3];
218*4882a593Smuzhiyun 
219*4882a593Smuzhiyun 	buffer[0] = status;
220*4882a593Smuzhiyun 	buffer[1] = note;
221*4882a593Smuzhiyun 	buffer[2] = velocity;
222*4882a593Smuzhiyun 
223*4882a593Smuzhiyun 	spin_lock_irqsave(&pm->rawmidi_in_lock, flags);
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 	if (!pm->in_substream)
226*4882a593Smuzhiyun 		goto drop_note;
227*4882a593Smuzhiyun 	if (!test_bit(pm->in_substream->number, &pm->in_triggered))
228*4882a593Smuzhiyun 		goto drop_note;
229*4882a593Smuzhiyun 
230*4882a593Smuzhiyun 	snd_rawmidi_receive(pm->in_substream, buffer, 3);
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun drop_note:
233*4882a593Smuzhiyun 	spin_unlock_irqrestore(&pm->rawmidi_in_lock, flags);
234*4882a593Smuzhiyun 
235*4882a593Smuzhiyun 	return;
236*4882a593Smuzhiyun }
237*4882a593Smuzhiyun 
pcmidi_sustained_note_release(struct timer_list * t)238*4882a593Smuzhiyun static void pcmidi_sustained_note_release(struct timer_list *t)
239*4882a593Smuzhiyun {
240*4882a593Smuzhiyun 	struct pcmidi_sustain *pms = from_timer(pms, t, timer);
241*4882a593Smuzhiyun 
242*4882a593Smuzhiyun 	pcmidi_send_note(pms->pm, pms->status, pms->note, pms->velocity);
243*4882a593Smuzhiyun 	pms->in_use = 0;
244*4882a593Smuzhiyun }
245*4882a593Smuzhiyun 
init_sustain_timers(struct pcmidi_snd * pm)246*4882a593Smuzhiyun static void init_sustain_timers(struct pcmidi_snd *pm)
247*4882a593Smuzhiyun {
248*4882a593Smuzhiyun 	struct pcmidi_sustain *pms;
249*4882a593Smuzhiyun 	unsigned i;
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 	for (i = 0; i < PCMIDI_SUSTAINED_MAX; i++) {
252*4882a593Smuzhiyun 		pms = &pm->sustained_notes[i];
253*4882a593Smuzhiyun 		pms->in_use = 0;
254*4882a593Smuzhiyun 		pms->pm = pm;
255*4882a593Smuzhiyun 		timer_setup(&pms->timer, pcmidi_sustained_note_release, 0);
256*4882a593Smuzhiyun 	}
257*4882a593Smuzhiyun }
258*4882a593Smuzhiyun 
stop_sustain_timers(struct pcmidi_snd * pm)259*4882a593Smuzhiyun static void stop_sustain_timers(struct pcmidi_snd *pm)
260*4882a593Smuzhiyun {
261*4882a593Smuzhiyun 	struct pcmidi_sustain *pms;
262*4882a593Smuzhiyun 	unsigned i;
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun 	for (i = 0; i < PCMIDI_SUSTAINED_MAX; i++) {
265*4882a593Smuzhiyun 		pms = &pm->sustained_notes[i];
266*4882a593Smuzhiyun 		pms->in_use = 1;
267*4882a593Smuzhiyun 		del_timer_sync(&pms->timer);
268*4882a593Smuzhiyun 	}
269*4882a593Smuzhiyun }
270*4882a593Smuzhiyun 
pcmidi_get_output_report(struct pcmidi_snd * pm)271*4882a593Smuzhiyun static int pcmidi_get_output_report(struct pcmidi_snd *pm)
272*4882a593Smuzhiyun {
273*4882a593Smuzhiyun 	struct hid_device *hdev = pm->pk->hdev;
274*4882a593Smuzhiyun 	struct hid_report *report;
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 	list_for_each_entry(report,
277*4882a593Smuzhiyun 		&hdev->report_enum[HID_OUTPUT_REPORT].report_list, list) {
278*4882a593Smuzhiyun 		if (!(6 == report->id))
279*4882a593Smuzhiyun 			continue;
280*4882a593Smuzhiyun 
281*4882a593Smuzhiyun 		if (report->maxfield < 1) {
282*4882a593Smuzhiyun 			hid_err(hdev, "output report is empty\n");
283*4882a593Smuzhiyun 			break;
284*4882a593Smuzhiyun 		}
285*4882a593Smuzhiyun 		if (report->field[0]->report_count != 2) {
286*4882a593Smuzhiyun 			hid_err(hdev, "field count too low\n");
287*4882a593Smuzhiyun 			break;
288*4882a593Smuzhiyun 		}
289*4882a593Smuzhiyun 		pm->pcmidi_report6 = report;
290*4882a593Smuzhiyun 		return 0;
291*4882a593Smuzhiyun 	}
292*4882a593Smuzhiyun 	/* should never get here */
293*4882a593Smuzhiyun 	return -ENODEV;
294*4882a593Smuzhiyun }
295*4882a593Smuzhiyun 
pcmidi_submit_output_report(struct pcmidi_snd * pm,int state)296*4882a593Smuzhiyun static void pcmidi_submit_output_report(struct pcmidi_snd *pm, int state)
297*4882a593Smuzhiyun {
298*4882a593Smuzhiyun 	struct hid_device *hdev = pm->pk->hdev;
299*4882a593Smuzhiyun 	struct hid_report *report = pm->pcmidi_report6;
300*4882a593Smuzhiyun 	report->field[0]->value[0] = 0x01;
301*4882a593Smuzhiyun 	report->field[0]->value[1] = state;
302*4882a593Smuzhiyun 
303*4882a593Smuzhiyun 	hid_hw_request(hdev, report, HID_REQ_SET_REPORT);
304*4882a593Smuzhiyun }
305*4882a593Smuzhiyun 
pcmidi_handle_report1(struct pcmidi_snd * pm,u8 * data)306*4882a593Smuzhiyun static int pcmidi_handle_report1(struct pcmidi_snd *pm, u8 *data)
307*4882a593Smuzhiyun {
308*4882a593Smuzhiyun 	u32 bit_mask;
309*4882a593Smuzhiyun 
310*4882a593Smuzhiyun 	bit_mask = data[1];
311*4882a593Smuzhiyun 	bit_mask = (bit_mask << 8) | data[2];
312*4882a593Smuzhiyun 	bit_mask = (bit_mask << 8) | data[3];
313*4882a593Smuzhiyun 
314*4882a593Smuzhiyun 	dbg_hid("pcmidi mode: %d\n", pm->midi_mode);
315*4882a593Smuzhiyun 
316*4882a593Smuzhiyun 	/*KEY_MAIL or octave down*/
317*4882a593Smuzhiyun 	if (pm->midi_mode && bit_mask == 0x004000) {
318*4882a593Smuzhiyun 		/* octave down */
319*4882a593Smuzhiyun 		pm->midi_octave--;
320*4882a593Smuzhiyun 		if (pm->midi_octave < -2)
321*4882a593Smuzhiyun 			pm->midi_octave = -2;
322*4882a593Smuzhiyun 		dbg_hid("pcmidi mode: %d octave: %d\n",
323*4882a593Smuzhiyun 			pm->midi_mode, pm->midi_octave);
324*4882a593Smuzhiyun 		return 1;
325*4882a593Smuzhiyun 	}
326*4882a593Smuzhiyun 	/*KEY_WWW or sustain*/
327*4882a593Smuzhiyun 	else if (pm->midi_mode && bit_mask == 0x000004) {
328*4882a593Smuzhiyun 		/* sustain on/off*/
329*4882a593Smuzhiyun 		pm->midi_sustain_mode ^= 0x1;
330*4882a593Smuzhiyun 		return 1;
331*4882a593Smuzhiyun 	}
332*4882a593Smuzhiyun 
333*4882a593Smuzhiyun 	return 0; /* continue key processing */
334*4882a593Smuzhiyun }
335*4882a593Smuzhiyun 
pcmidi_handle_report3(struct pcmidi_snd * pm,u8 * data,int size)336*4882a593Smuzhiyun static int pcmidi_handle_report3(struct pcmidi_snd *pm, u8 *data, int size)
337*4882a593Smuzhiyun {
338*4882a593Smuzhiyun 	struct pcmidi_sustain *pms;
339*4882a593Smuzhiyun 	unsigned i, j;
340*4882a593Smuzhiyun 	unsigned char status, note, velocity;
341*4882a593Smuzhiyun 
342*4882a593Smuzhiyun 	unsigned num_notes = (size-1)/2;
343*4882a593Smuzhiyun 	for (j = 0; j < num_notes; j++)	{
344*4882a593Smuzhiyun 		note = data[j*2+1];
345*4882a593Smuzhiyun 		velocity = data[j*2+2];
346*4882a593Smuzhiyun 
347*4882a593Smuzhiyun 		if (note < 0x81) { /* note on */
348*4882a593Smuzhiyun 			status = 128 + 16 + pm->midi_channel; /* 1001nnnn */
349*4882a593Smuzhiyun 			note = note - 0x54 + PCMIDI_MIDDLE_C +
350*4882a593Smuzhiyun 				(pm->midi_octave * 12);
351*4882a593Smuzhiyun 			if (0 == velocity)
352*4882a593Smuzhiyun 				velocity = 1; /* force note on */
353*4882a593Smuzhiyun 		} else { /* note off */
354*4882a593Smuzhiyun 			status = 128 + pm->midi_channel; /* 1000nnnn */
355*4882a593Smuzhiyun 			note = note - 0x94 + PCMIDI_MIDDLE_C +
356*4882a593Smuzhiyun 				(pm->midi_octave*12);
357*4882a593Smuzhiyun 
358*4882a593Smuzhiyun 			if (pm->midi_sustain_mode) {
359*4882a593Smuzhiyun 				for (i = 0; i < PCMIDI_SUSTAINED_MAX; i++) {
360*4882a593Smuzhiyun 					pms = &pm->sustained_notes[i];
361*4882a593Smuzhiyun 					if (!pms->in_use) {
362*4882a593Smuzhiyun 						pms->status = status;
363*4882a593Smuzhiyun 						pms->note = note;
364*4882a593Smuzhiyun 						pms->velocity = velocity;
365*4882a593Smuzhiyun 						pms->in_use = 1;
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun 						mod_timer(&pms->timer,
368*4882a593Smuzhiyun 							jiffies +
369*4882a593Smuzhiyun 					msecs_to_jiffies(pm->midi_sustain));
370*4882a593Smuzhiyun 						return 1;
371*4882a593Smuzhiyun 					}
372*4882a593Smuzhiyun 				}
373*4882a593Smuzhiyun 			}
374*4882a593Smuzhiyun 		}
375*4882a593Smuzhiyun 		pcmidi_send_note(pm, status, note, velocity);
376*4882a593Smuzhiyun 	}
377*4882a593Smuzhiyun 
378*4882a593Smuzhiyun 	return 1;
379*4882a593Smuzhiyun }
380*4882a593Smuzhiyun 
pcmidi_handle_report4(struct pcmidi_snd * pm,u8 * data)381*4882a593Smuzhiyun static int pcmidi_handle_report4(struct pcmidi_snd *pm, u8 *data)
382*4882a593Smuzhiyun {
383*4882a593Smuzhiyun 	unsigned	key;
384*4882a593Smuzhiyun 	u32		bit_mask;
385*4882a593Smuzhiyun 	u32		bit_index;
386*4882a593Smuzhiyun 
387*4882a593Smuzhiyun 	bit_mask = data[1];
388*4882a593Smuzhiyun 	bit_mask = (bit_mask << 8) | data[2];
389*4882a593Smuzhiyun 	bit_mask = (bit_mask << 8) | data[3];
390*4882a593Smuzhiyun 
391*4882a593Smuzhiyun 	/* break keys */
392*4882a593Smuzhiyun 	for (bit_index = 0; bit_index < 24; bit_index++) {
393*4882a593Smuzhiyun 		if (!((0x01 << bit_index) & bit_mask)) {
394*4882a593Smuzhiyun 			input_event(pm->input_ep82, EV_KEY,
395*4882a593Smuzhiyun 				pm->last_key[bit_index], 0);
396*4882a593Smuzhiyun 			pm->last_key[bit_index] = 0;
397*4882a593Smuzhiyun 		}
398*4882a593Smuzhiyun 	}
399*4882a593Smuzhiyun 
400*4882a593Smuzhiyun 	/* make keys */
401*4882a593Smuzhiyun 	for (bit_index = 0; bit_index < 24; bit_index++) {
402*4882a593Smuzhiyun 		key = 0;
403*4882a593Smuzhiyun 		switch ((0x01 << bit_index) & bit_mask) {
404*4882a593Smuzhiyun 		case 0x000010: /* Fn lock*/
405*4882a593Smuzhiyun 			pm->fn_state ^= 0x000010;
406*4882a593Smuzhiyun 			if (pm->fn_state)
407*4882a593Smuzhiyun 				pcmidi_submit_output_report(pm, 0xc5);
408*4882a593Smuzhiyun 			else
409*4882a593Smuzhiyun 				pcmidi_submit_output_report(pm, 0xc6);
410*4882a593Smuzhiyun 			continue;
411*4882a593Smuzhiyun 		case 0x020000: /* midi launcher..send a key (qwerty) or not? */
412*4882a593Smuzhiyun 			pcmidi_submit_output_report(pm, 0xc1);
413*4882a593Smuzhiyun 			pm->midi_mode ^= 0x01;
414*4882a593Smuzhiyun 
415*4882a593Smuzhiyun 			dbg_hid("pcmidi mode: %d\n", pm->midi_mode);
416*4882a593Smuzhiyun 			continue;
417*4882a593Smuzhiyun 		case 0x100000: /* KEY_MESSENGER or octave up */
418*4882a593Smuzhiyun 			dbg_hid("pcmidi mode: %d\n", pm->midi_mode);
419*4882a593Smuzhiyun 			if (pm->midi_mode) {
420*4882a593Smuzhiyun 				pm->midi_octave++;
421*4882a593Smuzhiyun 				if (pm->midi_octave > 2)
422*4882a593Smuzhiyun 					pm->midi_octave = 2;
423*4882a593Smuzhiyun 				dbg_hid("pcmidi mode: %d octave: %d\n",
424*4882a593Smuzhiyun 					pm->midi_mode, pm->midi_octave);
425*4882a593Smuzhiyun 				continue;
426*4882a593Smuzhiyun 			} else
427*4882a593Smuzhiyun 				key = KEY_MESSENGER;
428*4882a593Smuzhiyun 			break;
429*4882a593Smuzhiyun 		case 0x400000:
430*4882a593Smuzhiyun 			key = KEY_CALENDAR;
431*4882a593Smuzhiyun 			break;
432*4882a593Smuzhiyun 		case 0x080000:
433*4882a593Smuzhiyun 			key = KEY_ADDRESSBOOK;
434*4882a593Smuzhiyun 			break;
435*4882a593Smuzhiyun 		case 0x040000:
436*4882a593Smuzhiyun 			key = KEY_DOCUMENTS;
437*4882a593Smuzhiyun 			break;
438*4882a593Smuzhiyun 		case 0x800000:
439*4882a593Smuzhiyun 			key = KEY_WORDPROCESSOR;
440*4882a593Smuzhiyun 			break;
441*4882a593Smuzhiyun 		case 0x200000:
442*4882a593Smuzhiyun 			key = KEY_SPREADSHEET;
443*4882a593Smuzhiyun 			break;
444*4882a593Smuzhiyun 		case 0x010000:
445*4882a593Smuzhiyun 			key = KEY_COFFEE;
446*4882a593Smuzhiyun 			break;
447*4882a593Smuzhiyun 		case 0x000100:
448*4882a593Smuzhiyun 			key = KEY_HELP;
449*4882a593Smuzhiyun 			break;
450*4882a593Smuzhiyun 		case 0x000200:
451*4882a593Smuzhiyun 			key = KEY_SEND;
452*4882a593Smuzhiyun 			break;
453*4882a593Smuzhiyun 		case 0x000400:
454*4882a593Smuzhiyun 			key = KEY_REPLY;
455*4882a593Smuzhiyun 			break;
456*4882a593Smuzhiyun 		case 0x000800:
457*4882a593Smuzhiyun 			key = KEY_FORWARDMAIL;
458*4882a593Smuzhiyun 			break;
459*4882a593Smuzhiyun 		case 0x001000:
460*4882a593Smuzhiyun 			key = KEY_NEW;
461*4882a593Smuzhiyun 			break;
462*4882a593Smuzhiyun 		case 0x002000:
463*4882a593Smuzhiyun 			key = KEY_OPEN;
464*4882a593Smuzhiyun 			break;
465*4882a593Smuzhiyun 		case 0x004000:
466*4882a593Smuzhiyun 			key = KEY_CLOSE;
467*4882a593Smuzhiyun 			break;
468*4882a593Smuzhiyun 		case 0x008000:
469*4882a593Smuzhiyun 			key = KEY_SAVE;
470*4882a593Smuzhiyun 			break;
471*4882a593Smuzhiyun 		case 0x000001:
472*4882a593Smuzhiyun 			key = KEY_UNDO;
473*4882a593Smuzhiyun 			break;
474*4882a593Smuzhiyun 		case 0x000002:
475*4882a593Smuzhiyun 			key = KEY_REDO;
476*4882a593Smuzhiyun 			break;
477*4882a593Smuzhiyun 		case 0x000004:
478*4882a593Smuzhiyun 			key = KEY_SPELLCHECK;
479*4882a593Smuzhiyun 			break;
480*4882a593Smuzhiyun 		case 0x000008:
481*4882a593Smuzhiyun 			key = KEY_PRINT;
482*4882a593Smuzhiyun 			break;
483*4882a593Smuzhiyun 		}
484*4882a593Smuzhiyun 		if (key) {
485*4882a593Smuzhiyun 			input_event(pm->input_ep82, EV_KEY, key, 1);
486*4882a593Smuzhiyun 			pm->last_key[bit_index] = key;
487*4882a593Smuzhiyun 		}
488*4882a593Smuzhiyun 	}
489*4882a593Smuzhiyun 
490*4882a593Smuzhiyun 	return 1;
491*4882a593Smuzhiyun }
492*4882a593Smuzhiyun 
pcmidi_handle_report(struct pcmidi_snd * pm,unsigned report_id,u8 * data,int size)493*4882a593Smuzhiyun static int pcmidi_handle_report(
494*4882a593Smuzhiyun 	struct pcmidi_snd *pm, unsigned report_id, u8 *data, int size)
495*4882a593Smuzhiyun {
496*4882a593Smuzhiyun 	int ret = 0;
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun 	switch (report_id) {
499*4882a593Smuzhiyun 	case 0x01: /* midi keys (qwerty)*/
500*4882a593Smuzhiyun 		ret = pcmidi_handle_report1(pm, data);
501*4882a593Smuzhiyun 		break;
502*4882a593Smuzhiyun 	case 0x03: /* midi keyboard (musical)*/
503*4882a593Smuzhiyun 		ret = pcmidi_handle_report3(pm, data, size);
504*4882a593Smuzhiyun 		break;
505*4882a593Smuzhiyun 	case 0x04: /* multimedia/midi keys (qwerty)*/
506*4882a593Smuzhiyun 		ret = pcmidi_handle_report4(pm, data);
507*4882a593Smuzhiyun 		break;
508*4882a593Smuzhiyun 	}
509*4882a593Smuzhiyun 	return ret;
510*4882a593Smuzhiyun }
511*4882a593Smuzhiyun 
pcmidi_setup_extra_keys(struct pcmidi_snd * pm,struct input_dev * input)512*4882a593Smuzhiyun static void pcmidi_setup_extra_keys(
513*4882a593Smuzhiyun 	struct pcmidi_snd *pm, struct input_dev *input)
514*4882a593Smuzhiyun {
515*4882a593Smuzhiyun 	/* reassigned functionality for N/A keys
516*4882a593Smuzhiyun 		MY PICTURES =>	KEY_WORDPROCESSOR
517*4882a593Smuzhiyun 		MY MUSIC=>	KEY_SPREADSHEET
518*4882a593Smuzhiyun 	*/
519*4882a593Smuzhiyun 	static const unsigned int keys[] = {
520*4882a593Smuzhiyun 		KEY_FN,
521*4882a593Smuzhiyun 		KEY_MESSENGER, KEY_CALENDAR,
522*4882a593Smuzhiyun 		KEY_ADDRESSBOOK, KEY_DOCUMENTS,
523*4882a593Smuzhiyun 		KEY_WORDPROCESSOR,
524*4882a593Smuzhiyun 		KEY_SPREADSHEET,
525*4882a593Smuzhiyun 		KEY_COFFEE,
526*4882a593Smuzhiyun 		KEY_HELP, KEY_SEND,
527*4882a593Smuzhiyun 		KEY_REPLY, KEY_FORWARDMAIL,
528*4882a593Smuzhiyun 		KEY_NEW, KEY_OPEN,
529*4882a593Smuzhiyun 		KEY_CLOSE, KEY_SAVE,
530*4882a593Smuzhiyun 		KEY_UNDO, KEY_REDO,
531*4882a593Smuzhiyun 		KEY_SPELLCHECK,	KEY_PRINT,
532*4882a593Smuzhiyun 		0
533*4882a593Smuzhiyun 	};
534*4882a593Smuzhiyun 
535*4882a593Smuzhiyun 	const unsigned int *pkeys = &keys[0];
536*4882a593Smuzhiyun 	unsigned short i;
537*4882a593Smuzhiyun 
538*4882a593Smuzhiyun 	if (pm->ifnum != 1)  /* only set up ONCE for interace 1 */
539*4882a593Smuzhiyun 		return;
540*4882a593Smuzhiyun 
541*4882a593Smuzhiyun 	pm->input_ep82 = input;
542*4882a593Smuzhiyun 
543*4882a593Smuzhiyun 	for (i = 0; i < 24; i++)
544*4882a593Smuzhiyun 		pm->last_key[i] = 0;
545*4882a593Smuzhiyun 
546*4882a593Smuzhiyun 	while (*pkeys != 0) {
547*4882a593Smuzhiyun 		set_bit(*pkeys, pm->input_ep82->keybit);
548*4882a593Smuzhiyun 		++pkeys;
549*4882a593Smuzhiyun 	}
550*4882a593Smuzhiyun }
551*4882a593Smuzhiyun 
pcmidi_set_operational(struct pcmidi_snd * pm)552*4882a593Smuzhiyun static int pcmidi_set_operational(struct pcmidi_snd *pm)
553*4882a593Smuzhiyun {
554*4882a593Smuzhiyun 	int rc;
555*4882a593Smuzhiyun 
556*4882a593Smuzhiyun 	if (pm->ifnum != 1)
557*4882a593Smuzhiyun 		return 0; /* only set up ONCE for interace 1 */
558*4882a593Smuzhiyun 
559*4882a593Smuzhiyun 	rc = pcmidi_get_output_report(pm);
560*4882a593Smuzhiyun 	if (rc < 0)
561*4882a593Smuzhiyun 		return rc;
562*4882a593Smuzhiyun 	pcmidi_submit_output_report(pm, 0xc1);
563*4882a593Smuzhiyun 	return 0;
564*4882a593Smuzhiyun }
565*4882a593Smuzhiyun 
pcmidi_snd_free(struct snd_device * dev)566*4882a593Smuzhiyun static int pcmidi_snd_free(struct snd_device *dev)
567*4882a593Smuzhiyun {
568*4882a593Smuzhiyun 	return 0;
569*4882a593Smuzhiyun }
570*4882a593Smuzhiyun 
pcmidi_in_open(struct snd_rawmidi_substream * substream)571*4882a593Smuzhiyun static int pcmidi_in_open(struct snd_rawmidi_substream *substream)
572*4882a593Smuzhiyun {
573*4882a593Smuzhiyun 	struct pcmidi_snd *pm = substream->rmidi->private_data;
574*4882a593Smuzhiyun 
575*4882a593Smuzhiyun 	dbg_hid("pcmidi in open\n");
576*4882a593Smuzhiyun 	pm->in_substream = substream;
577*4882a593Smuzhiyun 	return 0;
578*4882a593Smuzhiyun }
579*4882a593Smuzhiyun 
pcmidi_in_close(struct snd_rawmidi_substream * substream)580*4882a593Smuzhiyun static int pcmidi_in_close(struct snd_rawmidi_substream *substream)
581*4882a593Smuzhiyun {
582*4882a593Smuzhiyun 	dbg_hid("pcmidi in close\n");
583*4882a593Smuzhiyun 	return 0;
584*4882a593Smuzhiyun }
585*4882a593Smuzhiyun 
pcmidi_in_trigger(struct snd_rawmidi_substream * substream,int up)586*4882a593Smuzhiyun static void pcmidi_in_trigger(struct snd_rawmidi_substream *substream, int up)
587*4882a593Smuzhiyun {
588*4882a593Smuzhiyun 	struct pcmidi_snd *pm = substream->rmidi->private_data;
589*4882a593Smuzhiyun 
590*4882a593Smuzhiyun 	dbg_hid("pcmidi in trigger %d\n", up);
591*4882a593Smuzhiyun 
592*4882a593Smuzhiyun 	pm->in_triggered = up;
593*4882a593Smuzhiyun }
594*4882a593Smuzhiyun 
595*4882a593Smuzhiyun static const struct snd_rawmidi_ops pcmidi_in_ops = {
596*4882a593Smuzhiyun 	.open = pcmidi_in_open,
597*4882a593Smuzhiyun 	.close = pcmidi_in_close,
598*4882a593Smuzhiyun 	.trigger = pcmidi_in_trigger
599*4882a593Smuzhiyun };
600*4882a593Smuzhiyun 
pcmidi_snd_initialise(struct pcmidi_snd * pm)601*4882a593Smuzhiyun static int pcmidi_snd_initialise(struct pcmidi_snd *pm)
602*4882a593Smuzhiyun {
603*4882a593Smuzhiyun 	static int dev;
604*4882a593Smuzhiyun 	struct snd_card *card;
605*4882a593Smuzhiyun 	struct snd_rawmidi *rwmidi;
606*4882a593Smuzhiyun 	int err;
607*4882a593Smuzhiyun 
608*4882a593Smuzhiyun 	static struct snd_device_ops ops = {
609*4882a593Smuzhiyun 		.dev_free = pcmidi_snd_free,
610*4882a593Smuzhiyun 	};
611*4882a593Smuzhiyun 
612*4882a593Smuzhiyun 	if (pm->ifnum != 1)
613*4882a593Smuzhiyun 		return 0; /* only set up midi device ONCE for interace 1 */
614*4882a593Smuzhiyun 
615*4882a593Smuzhiyun 	if (dev >= SNDRV_CARDS)
616*4882a593Smuzhiyun 		return -ENODEV;
617*4882a593Smuzhiyun 
618*4882a593Smuzhiyun 	if (!enable[dev]) {
619*4882a593Smuzhiyun 		dev++;
620*4882a593Smuzhiyun 		return -ENOENT;
621*4882a593Smuzhiyun 	}
622*4882a593Smuzhiyun 
623*4882a593Smuzhiyun 	/* Setup sound card */
624*4882a593Smuzhiyun 
625*4882a593Smuzhiyun 	err = snd_card_new(&pm->pk->hdev->dev, index[dev], id[dev],
626*4882a593Smuzhiyun 			   THIS_MODULE, 0, &card);
627*4882a593Smuzhiyun 	if (err < 0) {
628*4882a593Smuzhiyun 		pk_error("failed to create pc-midi sound card\n");
629*4882a593Smuzhiyun 		err = -ENOMEM;
630*4882a593Smuzhiyun 		goto fail;
631*4882a593Smuzhiyun 	}
632*4882a593Smuzhiyun 	pm->card = card;
633*4882a593Smuzhiyun 
634*4882a593Smuzhiyun 	/* Setup sound device */
635*4882a593Smuzhiyun 	err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, pm, &ops);
636*4882a593Smuzhiyun 	if (err < 0) {
637*4882a593Smuzhiyun 		pk_error("failed to create pc-midi sound device: error %d\n",
638*4882a593Smuzhiyun 			err);
639*4882a593Smuzhiyun 		goto fail;
640*4882a593Smuzhiyun 	}
641*4882a593Smuzhiyun 
642*4882a593Smuzhiyun 	strncpy(card->driver, shortname, sizeof(card->driver));
643*4882a593Smuzhiyun 	strncpy(card->shortname, shortname, sizeof(card->shortname));
644*4882a593Smuzhiyun 	strncpy(card->longname, longname, sizeof(card->longname));
645*4882a593Smuzhiyun 
646*4882a593Smuzhiyun 	/* Set up rawmidi */
647*4882a593Smuzhiyun 	err = snd_rawmidi_new(card, card->shortname, 0,
648*4882a593Smuzhiyun 			      0, 1, &rwmidi);
649*4882a593Smuzhiyun 	if (err < 0) {
650*4882a593Smuzhiyun 		pk_error("failed to create pc-midi rawmidi device: error %d\n",
651*4882a593Smuzhiyun 			err);
652*4882a593Smuzhiyun 		goto fail;
653*4882a593Smuzhiyun 	}
654*4882a593Smuzhiyun 	pm->rwmidi = rwmidi;
655*4882a593Smuzhiyun 	strncpy(rwmidi->name, card->shortname, sizeof(rwmidi->name));
656*4882a593Smuzhiyun 	rwmidi->info_flags = SNDRV_RAWMIDI_INFO_INPUT;
657*4882a593Smuzhiyun 	rwmidi->private_data = pm;
658*4882a593Smuzhiyun 
659*4882a593Smuzhiyun 	snd_rawmidi_set_ops(rwmidi, SNDRV_RAWMIDI_STREAM_INPUT,
660*4882a593Smuzhiyun 		&pcmidi_in_ops);
661*4882a593Smuzhiyun 
662*4882a593Smuzhiyun 	/* create sysfs variables */
663*4882a593Smuzhiyun 	err = device_create_file(&pm->pk->hdev->dev,
664*4882a593Smuzhiyun 				 sysfs_device_attr_channel);
665*4882a593Smuzhiyun 	if (err < 0) {
666*4882a593Smuzhiyun 		pk_error("failed to create sysfs attribute channel: error %d\n",
667*4882a593Smuzhiyun 			err);
668*4882a593Smuzhiyun 		goto fail;
669*4882a593Smuzhiyun 	}
670*4882a593Smuzhiyun 
671*4882a593Smuzhiyun 	err = device_create_file(&pm->pk->hdev->dev,
672*4882a593Smuzhiyun 				sysfs_device_attr_sustain);
673*4882a593Smuzhiyun 	if (err < 0) {
674*4882a593Smuzhiyun 		pk_error("failed to create sysfs attribute sustain: error %d\n",
675*4882a593Smuzhiyun 			err);
676*4882a593Smuzhiyun 		goto fail_attr_sustain;
677*4882a593Smuzhiyun 	}
678*4882a593Smuzhiyun 
679*4882a593Smuzhiyun 	err = device_create_file(&pm->pk->hdev->dev,
680*4882a593Smuzhiyun 			 sysfs_device_attr_octave);
681*4882a593Smuzhiyun 	if (err < 0) {
682*4882a593Smuzhiyun 		pk_error("failed to create sysfs attribute octave: error %d\n",
683*4882a593Smuzhiyun 			err);
684*4882a593Smuzhiyun 		goto fail_attr_octave;
685*4882a593Smuzhiyun 	}
686*4882a593Smuzhiyun 
687*4882a593Smuzhiyun 	spin_lock_init(&pm->rawmidi_in_lock);
688*4882a593Smuzhiyun 
689*4882a593Smuzhiyun 	init_sustain_timers(pm);
690*4882a593Smuzhiyun 	err = pcmidi_set_operational(pm);
691*4882a593Smuzhiyun 	if (err < 0) {
692*4882a593Smuzhiyun 		pk_error("failed to find output report\n");
693*4882a593Smuzhiyun 		goto fail_register;
694*4882a593Smuzhiyun 	}
695*4882a593Smuzhiyun 
696*4882a593Smuzhiyun 	/* register it */
697*4882a593Smuzhiyun 	err = snd_card_register(card);
698*4882a593Smuzhiyun 	if (err < 0) {
699*4882a593Smuzhiyun 		pk_error("failed to register pc-midi sound card: error %d\n",
700*4882a593Smuzhiyun 			 err);
701*4882a593Smuzhiyun 		goto fail_register;
702*4882a593Smuzhiyun 	}
703*4882a593Smuzhiyun 
704*4882a593Smuzhiyun 	dbg_hid("pcmidi_snd_initialise finished ok\n");
705*4882a593Smuzhiyun 	return 0;
706*4882a593Smuzhiyun 
707*4882a593Smuzhiyun fail_register:
708*4882a593Smuzhiyun 	stop_sustain_timers(pm);
709*4882a593Smuzhiyun 	device_remove_file(&pm->pk->hdev->dev, sysfs_device_attr_octave);
710*4882a593Smuzhiyun fail_attr_octave:
711*4882a593Smuzhiyun 	device_remove_file(&pm->pk->hdev->dev, sysfs_device_attr_sustain);
712*4882a593Smuzhiyun fail_attr_sustain:
713*4882a593Smuzhiyun 	device_remove_file(&pm->pk->hdev->dev, sysfs_device_attr_channel);
714*4882a593Smuzhiyun fail:
715*4882a593Smuzhiyun 	if (pm->card) {
716*4882a593Smuzhiyun 		snd_card_free(pm->card);
717*4882a593Smuzhiyun 		pm->card = NULL;
718*4882a593Smuzhiyun 	}
719*4882a593Smuzhiyun 	return err;
720*4882a593Smuzhiyun }
721*4882a593Smuzhiyun 
pcmidi_snd_terminate(struct pcmidi_snd * pm)722*4882a593Smuzhiyun static int pcmidi_snd_terminate(struct pcmidi_snd *pm)
723*4882a593Smuzhiyun {
724*4882a593Smuzhiyun 	if (pm->card) {
725*4882a593Smuzhiyun 		stop_sustain_timers(pm);
726*4882a593Smuzhiyun 
727*4882a593Smuzhiyun 		device_remove_file(&pm->pk->hdev->dev,
728*4882a593Smuzhiyun 			sysfs_device_attr_channel);
729*4882a593Smuzhiyun 		device_remove_file(&pm->pk->hdev->dev,
730*4882a593Smuzhiyun 			sysfs_device_attr_sustain);
731*4882a593Smuzhiyun 		device_remove_file(&pm->pk->hdev->dev,
732*4882a593Smuzhiyun 			sysfs_device_attr_octave);
733*4882a593Smuzhiyun 
734*4882a593Smuzhiyun 		snd_card_disconnect(pm->card);
735*4882a593Smuzhiyun 		snd_card_free_when_closed(pm->card);
736*4882a593Smuzhiyun 	}
737*4882a593Smuzhiyun 
738*4882a593Smuzhiyun 	return 0;
739*4882a593Smuzhiyun }
740*4882a593Smuzhiyun 
741*4882a593Smuzhiyun /*
742*4882a593Smuzhiyun  * PC-MIDI report descriptor for report id is wrong.
743*4882a593Smuzhiyun  */
pk_report_fixup(struct hid_device * hdev,__u8 * rdesc,unsigned int * rsize)744*4882a593Smuzhiyun static __u8 *pk_report_fixup(struct hid_device *hdev, __u8 *rdesc,
745*4882a593Smuzhiyun 		unsigned int *rsize)
746*4882a593Smuzhiyun {
747*4882a593Smuzhiyun 	if (*rsize == 178 &&
748*4882a593Smuzhiyun 	      rdesc[111] == 0x06 && rdesc[112] == 0x00 &&
749*4882a593Smuzhiyun 	      rdesc[113] == 0xff) {
750*4882a593Smuzhiyun 		hid_info(hdev,
751*4882a593Smuzhiyun 			 "fixing up pc-midi keyboard report descriptor\n");
752*4882a593Smuzhiyun 
753*4882a593Smuzhiyun 		rdesc[144] = 0x18; /* report 4: was 0x10 report count */
754*4882a593Smuzhiyun 	}
755*4882a593Smuzhiyun 	return rdesc;
756*4882a593Smuzhiyun }
757*4882a593Smuzhiyun 
pk_input_mapping(struct hid_device * hdev,struct hid_input * hi,struct hid_field * field,struct hid_usage * usage,unsigned long ** bit,int * max)758*4882a593Smuzhiyun static int pk_input_mapping(struct hid_device *hdev, struct hid_input *hi,
759*4882a593Smuzhiyun 		struct hid_field *field, struct hid_usage *usage,
760*4882a593Smuzhiyun 		unsigned long **bit, int *max)
761*4882a593Smuzhiyun {
762*4882a593Smuzhiyun 	struct pk_device *pk = hid_get_drvdata(hdev);
763*4882a593Smuzhiyun 	struct pcmidi_snd *pm;
764*4882a593Smuzhiyun 
765*4882a593Smuzhiyun 	pm = pk->pm;
766*4882a593Smuzhiyun 
767*4882a593Smuzhiyun 	if (HID_UP_MSVENDOR == (usage->hid & HID_USAGE_PAGE) &&
768*4882a593Smuzhiyun 		1 == pm->ifnum) {
769*4882a593Smuzhiyun 		pcmidi_setup_extra_keys(pm, hi->input);
770*4882a593Smuzhiyun 		return 0;
771*4882a593Smuzhiyun 	}
772*4882a593Smuzhiyun 
773*4882a593Smuzhiyun 	return 0;
774*4882a593Smuzhiyun }
775*4882a593Smuzhiyun 
776*4882a593Smuzhiyun 
pk_raw_event(struct hid_device * hdev,struct hid_report * report,u8 * data,int size)777*4882a593Smuzhiyun static int pk_raw_event(struct hid_device *hdev, struct hid_report *report,
778*4882a593Smuzhiyun 	u8 *data, int size)
779*4882a593Smuzhiyun {
780*4882a593Smuzhiyun 	struct pk_device *pk = hid_get_drvdata(hdev);
781*4882a593Smuzhiyun 	int ret = 0;
782*4882a593Smuzhiyun 
783*4882a593Smuzhiyun 	if (1 == pk->pm->ifnum) {
784*4882a593Smuzhiyun 		if (report->id == data[0])
785*4882a593Smuzhiyun 			switch (report->id) {
786*4882a593Smuzhiyun 			case 0x01: /* midi keys (qwerty)*/
787*4882a593Smuzhiyun 			case 0x03: /* midi keyboard (musical)*/
788*4882a593Smuzhiyun 			case 0x04: /* extra/midi keys (qwerty)*/
789*4882a593Smuzhiyun 				ret = pcmidi_handle_report(pk->pm,
790*4882a593Smuzhiyun 						report->id, data, size);
791*4882a593Smuzhiyun 				break;
792*4882a593Smuzhiyun 			}
793*4882a593Smuzhiyun 	}
794*4882a593Smuzhiyun 
795*4882a593Smuzhiyun 	return ret;
796*4882a593Smuzhiyun }
797*4882a593Smuzhiyun 
pk_probe(struct hid_device * hdev,const struct hid_device_id * id)798*4882a593Smuzhiyun static int pk_probe(struct hid_device *hdev, const struct hid_device_id *id)
799*4882a593Smuzhiyun {
800*4882a593Smuzhiyun 	int ret;
801*4882a593Smuzhiyun 	struct usb_interface *intf;
802*4882a593Smuzhiyun 	unsigned short ifnum;
803*4882a593Smuzhiyun 	unsigned long quirks = id->driver_data;
804*4882a593Smuzhiyun 	struct pk_device *pk;
805*4882a593Smuzhiyun 	struct pcmidi_snd *pm = NULL;
806*4882a593Smuzhiyun 
807*4882a593Smuzhiyun 	if (!hid_is_usb(hdev))
808*4882a593Smuzhiyun 		return -EINVAL;
809*4882a593Smuzhiyun 
810*4882a593Smuzhiyun 	intf = to_usb_interface(hdev->dev.parent);
811*4882a593Smuzhiyun 	ifnum = intf->cur_altsetting->desc.bInterfaceNumber;
812*4882a593Smuzhiyun 
813*4882a593Smuzhiyun 	pk = kzalloc(sizeof(*pk), GFP_KERNEL);
814*4882a593Smuzhiyun 	if (pk == NULL) {
815*4882a593Smuzhiyun 		hid_err(hdev, "can't alloc descriptor\n");
816*4882a593Smuzhiyun 		return -ENOMEM;
817*4882a593Smuzhiyun 	}
818*4882a593Smuzhiyun 
819*4882a593Smuzhiyun 	pk->hdev = hdev;
820*4882a593Smuzhiyun 
821*4882a593Smuzhiyun 	pm = kzalloc(sizeof(*pm), GFP_KERNEL);
822*4882a593Smuzhiyun 	if (pm == NULL) {
823*4882a593Smuzhiyun 		hid_err(hdev, "can't alloc descriptor\n");
824*4882a593Smuzhiyun 		ret = -ENOMEM;
825*4882a593Smuzhiyun 		goto err_free_pk;
826*4882a593Smuzhiyun 	}
827*4882a593Smuzhiyun 
828*4882a593Smuzhiyun 	pm->pk = pk;
829*4882a593Smuzhiyun 	pk->pm = pm;
830*4882a593Smuzhiyun 	pm->ifnum = ifnum;
831*4882a593Smuzhiyun 
832*4882a593Smuzhiyun 	hid_set_drvdata(hdev, pk);
833*4882a593Smuzhiyun 
834*4882a593Smuzhiyun 	ret = hid_parse(hdev);
835*4882a593Smuzhiyun 	if (ret) {
836*4882a593Smuzhiyun 		hid_err(hdev, "hid parse failed\n");
837*4882a593Smuzhiyun 		goto err_free;
838*4882a593Smuzhiyun 	}
839*4882a593Smuzhiyun 
840*4882a593Smuzhiyun 	if (quirks & PK_QUIRK_NOGET) { /* hid_parse cleared all the quirks */
841*4882a593Smuzhiyun 		hdev->quirks |= HID_QUIRK_NOGET;
842*4882a593Smuzhiyun 	}
843*4882a593Smuzhiyun 
844*4882a593Smuzhiyun 	ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT);
845*4882a593Smuzhiyun 	if (ret) {
846*4882a593Smuzhiyun 		hid_err(hdev, "hw start failed\n");
847*4882a593Smuzhiyun 		goto err_free;
848*4882a593Smuzhiyun 	}
849*4882a593Smuzhiyun 
850*4882a593Smuzhiyun 	ret = pcmidi_snd_initialise(pm);
851*4882a593Smuzhiyun 	if (ret < 0)
852*4882a593Smuzhiyun 		goto err_stop;
853*4882a593Smuzhiyun 
854*4882a593Smuzhiyun 	return 0;
855*4882a593Smuzhiyun err_stop:
856*4882a593Smuzhiyun 	hid_hw_stop(hdev);
857*4882a593Smuzhiyun err_free:
858*4882a593Smuzhiyun 	kfree(pm);
859*4882a593Smuzhiyun err_free_pk:
860*4882a593Smuzhiyun 	kfree(pk);
861*4882a593Smuzhiyun 
862*4882a593Smuzhiyun 	return ret;
863*4882a593Smuzhiyun }
864*4882a593Smuzhiyun 
pk_remove(struct hid_device * hdev)865*4882a593Smuzhiyun static void pk_remove(struct hid_device *hdev)
866*4882a593Smuzhiyun {
867*4882a593Smuzhiyun 	struct pk_device *pk = hid_get_drvdata(hdev);
868*4882a593Smuzhiyun 	struct pcmidi_snd *pm;
869*4882a593Smuzhiyun 
870*4882a593Smuzhiyun 	pm = pk->pm;
871*4882a593Smuzhiyun 	if (pm) {
872*4882a593Smuzhiyun 		pcmidi_snd_terminate(pm);
873*4882a593Smuzhiyun 		kfree(pm);
874*4882a593Smuzhiyun 	}
875*4882a593Smuzhiyun 
876*4882a593Smuzhiyun 	hid_hw_stop(hdev);
877*4882a593Smuzhiyun 
878*4882a593Smuzhiyun 	kfree(pk);
879*4882a593Smuzhiyun }
880*4882a593Smuzhiyun 
881*4882a593Smuzhiyun static const struct hid_device_id pk_devices[] = {
882*4882a593Smuzhiyun 	{HID_USB_DEVICE(USB_VENDOR_ID_CREATIVELABS,
883*4882a593Smuzhiyun 		USB_DEVICE_ID_PRODIKEYS_PCMIDI),
884*4882a593Smuzhiyun 	    .driver_data = PK_QUIRK_NOGET},
885*4882a593Smuzhiyun 	{ }
886*4882a593Smuzhiyun };
887*4882a593Smuzhiyun MODULE_DEVICE_TABLE(hid, pk_devices);
888*4882a593Smuzhiyun 
889*4882a593Smuzhiyun static struct hid_driver pk_driver = {
890*4882a593Smuzhiyun 	.name = "prodikeys",
891*4882a593Smuzhiyun 	.id_table = pk_devices,
892*4882a593Smuzhiyun 	.report_fixup = pk_report_fixup,
893*4882a593Smuzhiyun 	.input_mapping = pk_input_mapping,
894*4882a593Smuzhiyun 	.raw_event = pk_raw_event,
895*4882a593Smuzhiyun 	.probe = pk_probe,
896*4882a593Smuzhiyun 	.remove = pk_remove,
897*4882a593Smuzhiyun };
898*4882a593Smuzhiyun module_hid_driver(pk_driver);
899*4882a593Smuzhiyun 
900*4882a593Smuzhiyun MODULE_LICENSE("GPL");
901