[PATCH] sun3 __iomem annotations
[linux-2.6.git] / drivers / media / common / ir-functions.c
1 /*
2  *
3  * some common structs and functions to handle infrared remotes via
4  * input layer ...
5  *
6  * (c) 2003 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
7  *
8  *  This program is free software; you can redistribute it and/or modify
9  *  it under the terms of the GNU General Public License as published by
10  *  the Free Software Foundation; either version 2 of the License, or
11  *  (at your option) any later version.
12  *
13  *  This program is distributed in the hope that it will be useful,
14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  *  GNU General Public License for more details.
17  *
18  *  You should have received a copy of the GNU General Public License
19  *  along with this program; if not, write to the Free Software
20  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
21  */
22
23 #include <linux/module.h>
24 #include <linux/moduleparam.h>
25 #include <linux/string.h>
26 #include <media/ir-common.h>
27
28 /* -------------------------------------------------------------------------- */
29
30 MODULE_AUTHOR("Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]");
31 MODULE_LICENSE("GPL");
32
33 static int repeat = 1;
34 module_param(repeat, int, 0444);
35 MODULE_PARM_DESC(repeat,"auto-repeat for IR keys (default: on)");
36
37 static int debug = 0;    /* debug level (0,1,2) */
38 module_param(debug, int, 0644);
39
40 #define dprintk(level, fmt, arg...)     if (debug >= level) \
41         printk(KERN_DEBUG fmt , ## arg)
42
43 /* -------------------------------------------------------------------------- */
44
45 static void ir_input_key_event(struct input_dev *dev, struct ir_input_state *ir)
46 {
47         if (KEY_RESERVED == ir->keycode) {
48                 printk(KERN_INFO "%s: unknown key: key=0x%02x raw=0x%02x down=%d\n",
49                        dev->name,ir->ir_key,ir->ir_raw,ir->keypressed);
50                 return;
51         }
52         dprintk(1,"%s: key event code=%d down=%d\n",
53                 dev->name,ir->keycode,ir->keypressed);
54         input_report_key(dev,ir->keycode,ir->keypressed);
55         input_sync(dev);
56 }
57
58 /* -------------------------------------------------------------------------- */
59
60 void ir_input_init(struct input_dev *dev, struct ir_input_state *ir,
61                    int ir_type, IR_KEYTAB_TYPE *ir_codes)
62 {
63         int i;
64
65         ir->ir_type = ir_type;
66         if (ir_codes)
67                 memcpy(ir->ir_codes, ir_codes, sizeof(ir->ir_codes));
68
69
70         dev->keycode     = ir->ir_codes;
71         dev->keycodesize = sizeof(IR_KEYTAB_TYPE);
72         dev->keycodemax  = IR_KEYTAB_SIZE;
73         for (i = 0; i < IR_KEYTAB_SIZE; i++)
74                 set_bit(ir->ir_codes[i], dev->keybit);
75         clear_bit(0, dev->keybit);
76
77         set_bit(EV_KEY, dev->evbit);
78         if (repeat)
79                 set_bit(EV_REP, dev->evbit);
80 }
81
82 void ir_input_nokey(struct input_dev *dev, struct ir_input_state *ir)
83 {
84         if (ir->keypressed) {
85                 ir->keypressed = 0;
86                 ir_input_key_event(dev,ir);
87         }
88 }
89
90 void ir_input_keydown(struct input_dev *dev, struct ir_input_state *ir,
91                       u32 ir_key, u32 ir_raw)
92 {
93         u32 keycode = IR_KEYCODE(ir->ir_codes, ir_key);
94
95         if (ir->keypressed && ir->keycode != keycode) {
96                 ir->keypressed = 0;
97                 ir_input_key_event(dev,ir);
98         }
99         if (!ir->keypressed) {
100                 ir->ir_key  = ir_key;
101                 ir->ir_raw  = ir_raw;
102                 ir->keycode = keycode;
103                 ir->keypressed = 1;
104                 ir_input_key_event(dev,ir);
105         }
106 }
107
108 /* -------------------------------------------------------------------------- */
109
110 u32 ir_extract_bits(u32 data, u32 mask)
111 {
112         int mbit, vbit;
113         u32 value;
114
115         value = 0;
116         vbit  = 0;
117         for (mbit = 0; mbit < 32; mbit++) {
118                 if (!(mask & ((u32)1 << mbit)))
119                         continue;
120                 if (data & ((u32)1 << mbit))
121                         value |= (1 << vbit);
122                 vbit++;
123         }
124         return value;
125 }
126
127 static int inline getbit(u32 *samples, int bit)
128 {
129         return (samples[bit/32] & (1 << (31-(bit%32)))) ? 1 : 0;
130 }
131
132 /* sump raw samples for visual debugging ;) */
133 int ir_dump_samples(u32 *samples, int count)
134 {
135         int i, bit, start;
136
137         printk(KERN_DEBUG "ir samples: ");
138         start = 0;
139         for (i = 0; i < count * 32; i++) {
140                 bit = getbit(samples,i);
141                 if (bit)
142                         start = 1;
143                 if (0 == start)
144                         continue;
145                 printk("%s", bit ? "#" : "_");
146         }
147         printk("\n");
148         return 0;
149 }
150
151 /* decode raw samples, pulse distance coding used by NEC remotes */
152 int ir_decode_pulsedistance(u32 *samples, int count, int low, int high)
153 {
154         int i,last,bit,len;
155         u32 curBit;
156         u32 value;
157
158         /* find start burst */
159         for (i = len = 0; i < count * 32; i++) {
160                 bit = getbit(samples,i);
161                 if (bit) {
162                         len++;
163                 } else {
164                         if (len >= 29)
165                                 break;
166                         len = 0;
167                 }
168         }
169
170         /* start burst to short */
171         if (len < 29)
172                 return 0xffffffff;
173
174         /* find start silence */
175         for (len = 0; i < count * 32; i++) {
176                 bit = getbit(samples,i);
177                 if (bit) {
178                         break;
179                 } else {
180                         len++;
181                 }
182         }
183
184         /* silence to short */
185         if (len < 7)
186                 return 0xffffffff;
187
188         /* go decoding */
189         len   = 0;
190         last = 1;
191         value = 0; curBit = 1;
192         for (; i < count * 32; i++) {
193                 bit  = getbit(samples,i);
194                 if (last) {
195                         if(bit) {
196                                 continue;
197                         } else {
198                                 len = 1;
199                         }
200                 } else {
201                         if (bit) {
202                                 if (len > (low + high) /2)
203                                         value |= curBit;
204                                 curBit <<= 1;
205                                 if (curBit == 1)
206                                         break;
207                         } else {
208                                 len++;
209                         }
210                 }
211                 last = bit;
212         }
213
214         return value;
215 }
216
217 /* decode raw samples, biphase coding, used by rc5 for example */
218 int ir_decode_biphase(u32 *samples, int count, int low, int high)
219 {
220         int i,last,bit,len,flips;
221         u32 value;
222
223         /* find start bit (1) */
224         for (i = 0; i < 32; i++) {
225                 bit = getbit(samples,i);
226                 if (bit)
227                         break;
228         }
229
230         /* go decoding */
231         len   = 0;
232         flips = 0;
233         value = 1;
234         for (; i < count * 32; i++) {
235                 if (len > high)
236                         break;
237                 if (flips > 1)
238                         break;
239                 last = bit;
240                 bit  = getbit(samples,i);
241                 if (last == bit) {
242                         len++;
243                         continue;
244                 }
245                 if (len < low) {
246                         len++;
247                         flips++;
248                         continue;
249                 }
250                 value <<= 1;
251                 value |= bit;
252                 flips = 0;
253                 len   = 1;
254         }
255         return value;
256 }
257
258 EXPORT_SYMBOL_GPL(ir_input_init);
259 EXPORT_SYMBOL_GPL(ir_input_nokey);
260 EXPORT_SYMBOL_GPL(ir_input_keydown);
261
262 EXPORT_SYMBOL_GPL(ir_extract_bits);
263 EXPORT_SYMBOL_GPL(ir_dump_samples);
264 EXPORT_SYMBOL_GPL(ir_decode_biphase);
265 EXPORT_SYMBOL_GPL(ir_decode_pulsedistance);
266
267 /*
268  * Local variables:
269  * c-basic-offset: 8
270  * End:
271  */