[ALSA] caiaq - support for Native Instrument's RigKontrol3
[linux-2.6.git] / sound / usb / caiaq / caiaq-input.c
1 /*
2  *   Copyright (c) 2006,2007 Daniel Mack, Tim Ruetz
3  *
4  *   This program is free software; you can redistribute it and/or modify
5  *   it under the terms of the GNU General Public License as published by
6  *   the Free Software Foundation; either version 2 of the License, or
7  *   (at your option) any later version.
8  *
9  *   This program is distributed in the hope that it will be useful,
10  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
11  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12  *   GNU General Public License for more details.
13  *
14  *   You should have received a copy of the GNU General Public License
15  *   along with this program; if not, write to the Free Software
16  *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
17 */
18
19 #include <linux/init.h>
20 #include <linux/module.h>
21 #include <linux/moduleparam.h>
22 #include <linux/input.h>
23 #include <linux/usb.h>
24 #include <linux/spinlock.h>
25 #include <sound/driver.h>
26 #include <sound/core.h>
27 #include <sound/rawmidi.h>
28 #include <sound/pcm.h>
29 #include "caiaq-device.h"
30 #include "caiaq-input.h"
31
32 #ifdef CONFIG_SND_USB_CAIAQ_INPUT
33
34 static unsigned char keycode_ak1[] =  { KEY_C, KEY_B, KEY_A };
35 static unsigned char keycode_rk2[] =  { KEY_1, KEY_2, KEY_3, KEY_4, 
36                                         KEY_5, KEY_6, KEY_7 };
37 static unsigned char keycode_rk3[] =  { KEY_1, KEY_2, KEY_3, KEY_4,
38                                         KEY_5, KEY_6, KEY_7, KEY_5, KEY_6 };
39
40 #define DEG90  (range/2)
41 #define DEG180 (range)
42 #define DEG270 (DEG90 + DEG180)
43 #define DEG360 (DEG180 * 2)
44 #define HIGH_PEAK (268)
45 #define LOW_PEAK (-7)
46
47 /* some of these devices have endless rotation potentiometers
48  * built in which use two tapers, 90 degrees phase shifted.
49  * this algorithm decodes them to one single value, ranging
50  * from 0 to 999 */
51 static unsigned int decode_erp(unsigned char a, unsigned char b)
52 {
53         int weight_a, weight_b;
54         int pos_a, pos_b;
55         int ret;
56         int range = HIGH_PEAK - LOW_PEAK;
57         int mid_value = (HIGH_PEAK + LOW_PEAK) / 2;
58
59         weight_b = abs(mid_value-a) - (range/2 - 100)/2;
60         
61         if (weight_b < 0)
62                 weight_b = 0;
63
64         if (weight_b > 100)
65                 weight_b = 100;
66
67         weight_a = 100 - weight_b;
68
69         if (a < mid_value) {
70                 /* 0..90 and 270..360 degrees */
71                 pos_b = b - LOW_PEAK + DEG270;
72                 if (pos_b >= DEG360)
73                         pos_b -= DEG360;
74         } else
75                 /* 90..270 degrees */
76                 pos_b = HIGH_PEAK - b + DEG90;
77
78
79         if (b > mid_value)
80                 /* 0..180 degrees */
81                 pos_a = a - LOW_PEAK;
82         else
83                 /* 180..360 degrees */
84                 pos_a = HIGH_PEAK - a + DEG180;
85
86         /* interpolate both slider values, depending on weight factors */
87         /* 0..99 x DEG360 */
88         ret = pos_a * weight_a + pos_b * weight_b;
89
90         /* normalize to 0..999 */
91         ret *= 10;
92         ret /= DEG360;
93
94         if (ret < 0)
95                 ret += 1000;
96         
97         if (ret >= 1000)
98                 ret -= 1000;
99
100         return ret;
101 }
102
103 #undef DEG90
104 #undef DEG180
105 #undef DEG270
106 #undef DEG360
107 #undef HIGH_PEAK
108 #undef LOW_PEAK
109
110
111 static void snd_caiaq_input_read_analog(struct snd_usb_caiaqdev *dev, 
112                                         const unsigned char *buf,
113                                         unsigned int len)
114 {
115         switch(dev->input_dev->id.product) {
116         case USB_PID_RIGKONTROL2:
117                 input_report_abs(dev->input_dev, ABS_X, (buf[4] << 8) |buf[5]);
118                 input_report_abs(dev->input_dev, ABS_Y, (buf[0] << 8) |buf[1]);
119                 input_report_abs(dev->input_dev, ABS_Z, (buf[2] << 8) |buf[3]);
120                 input_sync(dev->input_dev);
121                 break;
122         case USB_PID_RIGKONTROL3:
123                 input_report_abs(dev->input_dev, ABS_X, (buf[0] << 8) |buf[1]);
124                 input_report_abs(dev->input_dev, ABS_Y, (buf[2] << 8) |buf[3]);
125                 input_report_abs(dev->input_dev, ABS_Z, (buf[4] << 8) |buf[5]);
126                 input_sync(dev->input_dev);
127                 break;
128         }
129 }
130
131 static void snd_caiaq_input_read_erp(struct snd_usb_caiaqdev *dev, 
132                                      const char *buf, unsigned int len)
133 {
134         int i;
135
136         switch(dev->input_dev->id.product) {
137         case USB_PID_AK1:
138                 i = decode_erp(buf[0], buf[1]);
139                 input_report_abs(dev->input_dev, ABS_X, i);
140                 input_sync(dev->input_dev);
141                 break;
142         }
143 }
144
145 static void snd_caiaq_input_read_io(struct snd_usb_caiaqdev *dev, 
146                                     char *buf, unsigned int len)
147 {
148         int i;
149         unsigned char *keycode = dev->input_dev->keycode;
150
151         if (!keycode)
152                 return;
153
154         if (dev->input_dev->id.product == USB_PID_RIGKONTROL2)
155                 for (i=0; i<len; i++)
156                         buf[i] = ~buf[i];
157
158         for (i=0; (i<dev->input_dev->keycodemax) && (i < len); i++)
159                 input_report_key(dev->input_dev, keycode[i], 
160                                         buf[i/8] & (1 << (i%8)));
161
162         input_sync(dev->input_dev);
163 }
164
165 void snd_usb_caiaq_input_dispatch(struct snd_usb_caiaqdev *dev, 
166                                   char *buf, 
167                                   unsigned int len)
168 {
169         if (!dev->input_dev || (len < 1))
170                 return;
171
172         switch (buf[0]) {
173         case EP1_CMD_READ_ANALOG:
174                 snd_caiaq_input_read_analog(dev, buf+1, len-1);
175                 break;
176         case EP1_CMD_READ_ERP:
177                 snd_caiaq_input_read_erp(dev, buf+1, len-1);
178                 break;
179         case EP1_CMD_READ_IO:
180                 snd_caiaq_input_read_io(dev, buf+1, len-1);
181                 break;
182         }
183 }
184
185 int snd_usb_caiaq_input_init(struct snd_usb_caiaqdev *dev)
186 {
187         struct usb_device *usb_dev = dev->chip.dev;
188         struct input_dev *input;
189         int i, ret;
190
191         input = input_allocate_device();
192         if (!input)
193                 return -ENOMEM;
194
195         input->name = dev->product_name;
196         input->id.bustype = BUS_USB;
197         input->id.vendor  = usb_dev->descriptor.idVendor;
198         input->id.product = usb_dev->descriptor.idProduct;
199         input->id.version = usb_dev->descriptor.bcdDevice;
200
201         switch (dev->chip.usb_id) {
202         case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_RIGKONTROL2):
203                 input->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS);
204                 input->absbit[0] = BIT(ABS_X) | BIT(ABS_Y) | BIT(ABS_Z);
205                 input->keycode = keycode_rk2;
206                 input->keycodesize = sizeof(char);
207                 input->keycodemax = ARRAY_SIZE(keycode_rk2);
208                 for (i=0; i<ARRAY_SIZE(keycode_rk2); i++)
209                         set_bit(keycode_rk2[i], input->keybit);
210
211                 input_set_abs_params(input, ABS_X, 0, 4096, 0, 10);
212                 input_set_abs_params(input, ABS_Y, 0, 4096, 0, 10);
213                 input_set_abs_params(input, ABS_Z, 0, 4096, 0, 10);
214                 snd_usb_caiaq_set_auto_msg(dev, 1, 10, 0);
215                 break;
216         case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_RIGKONTROL3):
217                 input->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS);
218                 input->absbit[0] = BIT(ABS_X) | BIT(ABS_Y) | BIT(ABS_Z);
219                 input->keycode = keycode_rk3;
220                 input->keycodesize = sizeof(char);
221                 input->keycodemax = ARRAY_SIZE(keycode_rk3);
222                 for (i=0; i<ARRAY_SIZE(keycode_rk3); i++)
223                         set_bit(keycode_rk3[i], input->keybit);
224
225                 input_set_abs_params(input, ABS_X, 0, 1024, 0, 10);
226                 input_set_abs_params(input, ABS_Y, 0, 1024, 0, 10);
227                 input_set_abs_params(input, ABS_Z, 0, 1024, 0, 10);
228                 snd_usb_caiaq_set_auto_msg(dev, 1, 10, 0);
229                 break;
230         case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_AK1):
231                 input->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS);
232                 input->absbit[0] = BIT(ABS_X);
233                 input->keycode = keycode_ak1;
234                 input->keycodesize = sizeof(char);
235                 input->keycodemax = ARRAY_SIZE(keycode_ak1);
236                 for (i=0; i<ARRAY_SIZE(keycode_ak1); i++)
237                         set_bit(keycode_ak1[i], input->keybit);
238
239                 input_set_abs_params(input, ABS_X, 0, 999, 0, 10);
240                 snd_usb_caiaq_set_auto_msg(dev, 1, 0, 5);
241                 break;
242         default:
243                 /* no input methods supported on this device */
244                 input_free_device(input);
245                 return 0;
246         }
247
248         ret = input_register_device(input);
249         if (ret < 0) {
250                 input_free_device(input);
251                 return ret;
252         }
253
254         dev->input_dev = input;
255         return 0;
256 }
257
258 void snd_usb_caiaq_input_free(struct snd_usb_caiaqdev *dev)
259 {
260         if (!dev || !dev->input_dev)
261                 return;
262
263         input_unregister_device(dev->input_dev);
264         dev->input_dev = NULL;
265 }
266
267 #endif /* CONFIG_SND_USB_CAIAQ_INPUT */
268