Merge branch 'next-s3c' of git://aeryn.fluff.org.uk/bjdooks/linux into devel
[linux-2.6] / drivers / media / video / pvrusb2 / pvrusb2-ctrl.c
1 /*
2  *
3  *
4  *  Copyright (C) 2005 Mike Isely <isely@pobox.com>
5  *
6  *  This program is free software; you can redistribute it and/or modify
7  *  it under the terms of the GNU General Public License as published by
8  *  the Free Software Foundation; either version 2 of the License
9  *
10  *  This program is distributed in the hope that it will be useful,
11  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
12  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  *  GNU General Public License for more details.
14  *
15  *  You should have received a copy of the GNU General Public License
16  *  along with this program; if not, write to the Free Software
17  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
18  *
19  */
20
21 #include "pvrusb2-ctrl.h"
22 #include "pvrusb2-hdw-internal.h"
23 #include <linux/errno.h>
24 #include <linux/string.h>
25 #include <linux/mutex.h>
26
27
28 static int pvr2_ctrl_range_check(struct pvr2_ctrl *cptr,int val)
29 {
30         if (cptr->info->check_value) {
31                 if (!cptr->info->check_value(cptr,val)) return -ERANGE;
32         } else if (cptr->info->type == pvr2_ctl_enum) {
33                 if (val < 0) return -ERANGE;
34                 if (val >= cptr->info->def.type_enum.count) return -ERANGE;
35         } else {
36                 int lim;
37                 lim = cptr->info->def.type_int.min_value;
38                 if (cptr->info->get_min_value) {
39                         cptr->info->get_min_value(cptr,&lim);
40                 }
41                 if (val < lim) return -ERANGE;
42                 lim = cptr->info->def.type_int.max_value;
43                 if (cptr->info->get_max_value) {
44                         cptr->info->get_max_value(cptr,&lim);
45                 }
46                 if (val > lim) return -ERANGE;
47         }
48         return 0;
49 }
50
51
52 /* Set the given control. */
53 int pvr2_ctrl_set_value(struct pvr2_ctrl *cptr,int val)
54 {
55         return pvr2_ctrl_set_mask_value(cptr,~0,val);
56 }
57
58
59 /* Set/clear specific bits of the given control. */
60 int pvr2_ctrl_set_mask_value(struct pvr2_ctrl *cptr,int mask,int val)
61 {
62         int ret = 0;
63         if (!cptr) return -EINVAL;
64         LOCK_TAKE(cptr->hdw->big_lock); do {
65                 if (cptr->info->set_value) {
66                         if (cptr->info->type == pvr2_ctl_bitmask) {
67                                 mask &= cptr->info->def.type_bitmask.valid_bits;
68                         } else if ((cptr->info->type == pvr2_ctl_int)||
69                                    (cptr->info->type == pvr2_ctl_enum)) {
70                                 ret = pvr2_ctrl_range_check(cptr,val);
71                                 if (ret < 0) break;
72                         } else if (cptr->info->type != pvr2_ctl_bool) {
73                                 break;
74                         }
75                         ret = cptr->info->set_value(cptr,mask,val);
76                 } else {
77                         ret = -EPERM;
78                 }
79         } while(0); LOCK_GIVE(cptr->hdw->big_lock);
80         return ret;
81 }
82
83
84 /* Get the current value of the given control. */
85 int pvr2_ctrl_get_value(struct pvr2_ctrl *cptr,int *valptr)
86 {
87         int ret = 0;
88         if (!cptr) return -EINVAL;
89         LOCK_TAKE(cptr->hdw->big_lock); do {
90                 ret = cptr->info->get_value(cptr,valptr);
91         } while(0); LOCK_GIVE(cptr->hdw->big_lock);
92         return ret;
93 }
94
95
96 /* Retrieve control's type */
97 enum pvr2_ctl_type pvr2_ctrl_get_type(struct pvr2_ctrl *cptr)
98 {
99         if (!cptr) return pvr2_ctl_int;
100         return cptr->info->type;
101 }
102
103
104 /* Retrieve control's maximum value (int type) */
105 int pvr2_ctrl_get_max(struct pvr2_ctrl *cptr)
106 {
107         int ret = 0;
108         if (!cptr) return 0;
109         LOCK_TAKE(cptr->hdw->big_lock); do {
110                 if (cptr->info->get_max_value) {
111                         cptr->info->get_max_value(cptr,&ret);
112                 } else if (cptr->info->type == pvr2_ctl_int) {
113                         ret = cptr->info->def.type_int.max_value;
114                 }
115         } while(0); LOCK_GIVE(cptr->hdw->big_lock);
116         return ret;
117 }
118
119
120 /* Retrieve control's minimum value (int type) */
121 int pvr2_ctrl_get_min(struct pvr2_ctrl *cptr)
122 {
123         int ret = 0;
124         if (!cptr) return 0;
125         LOCK_TAKE(cptr->hdw->big_lock); do {
126                 if (cptr->info->get_min_value) {
127                         cptr->info->get_min_value(cptr,&ret);
128                 } else if (cptr->info->type == pvr2_ctl_int) {
129                         ret = cptr->info->def.type_int.min_value;
130                 }
131         } while(0); LOCK_GIVE(cptr->hdw->big_lock);
132         return ret;
133 }
134
135
136 /* Retrieve control's default value (any type) */
137 int pvr2_ctrl_get_def(struct pvr2_ctrl *cptr, int *valptr)
138 {
139         int ret = 0;
140         if (!cptr) return -EINVAL;
141         LOCK_TAKE(cptr->hdw->big_lock); do {
142                 if (cptr->info->get_def_value) {
143                         ret = cptr->info->get_def_value(cptr, valptr);
144                 } else {
145                         *valptr = cptr->info->default_value;
146                 }
147         } while(0); LOCK_GIVE(cptr->hdw->big_lock);
148         return ret;
149 }
150
151
152 /* Retrieve control's enumeration count (enum only) */
153 int pvr2_ctrl_get_cnt(struct pvr2_ctrl *cptr)
154 {
155         int ret = 0;
156         if (!cptr) return 0;
157         LOCK_TAKE(cptr->hdw->big_lock); do {
158                 if (cptr->info->type == pvr2_ctl_enum) {
159                         ret = cptr->info->def.type_enum.count;
160                 }
161         } while(0); LOCK_GIVE(cptr->hdw->big_lock);
162         return ret;
163 }
164
165
166 /* Retrieve control's valid mask bits (bit mask only) */
167 int pvr2_ctrl_get_mask(struct pvr2_ctrl *cptr)
168 {
169         int ret = 0;
170         if (!cptr) return 0;
171         LOCK_TAKE(cptr->hdw->big_lock); do {
172                 if (cptr->info->type == pvr2_ctl_bitmask) {
173                         ret = cptr->info->def.type_bitmask.valid_bits;
174                 }
175         } while(0); LOCK_GIVE(cptr->hdw->big_lock);
176         return ret;
177 }
178
179
180 /* Retrieve the control's name */
181 const char *pvr2_ctrl_get_name(struct pvr2_ctrl *cptr)
182 {
183         if (!cptr) return NULL;
184         return cptr->info->name;
185 }
186
187
188 /* Retrieve the control's desc */
189 const char *pvr2_ctrl_get_desc(struct pvr2_ctrl *cptr)
190 {
191         if (!cptr) return NULL;
192         return cptr->info->desc;
193 }
194
195
196 /* Retrieve a control enumeration or bit mask value */
197 int pvr2_ctrl_get_valname(struct pvr2_ctrl *cptr,int val,
198                           char *bptr,unsigned int bmax,
199                           unsigned int *blen)
200 {
201         int ret = -EINVAL;
202         if (!cptr) return 0;
203         *blen = 0;
204         LOCK_TAKE(cptr->hdw->big_lock); do {
205                 if (cptr->info->type == pvr2_ctl_enum) {
206                         const char **names;
207                         names = cptr->info->def.type_enum.value_names;
208                         if (pvr2_ctrl_range_check(cptr,val) == 0) {
209                                 if (names[val]) {
210                                         *blen = scnprintf(
211                                                 bptr,bmax,"%s",
212                                                 names[val]);
213                                 } else {
214                                         *blen = 0;
215                                 }
216                                 ret = 0;
217                         }
218                 } else if (cptr->info->type == pvr2_ctl_bitmask) {
219                         const char **names;
220                         unsigned int idx;
221                         int msk;
222                         names = cptr->info->def.type_bitmask.bit_names;
223                         val &= cptr->info->def.type_bitmask.valid_bits;
224                         for (idx = 0, msk = 1; val; idx++, msk <<= 1) {
225                                 if (val & msk) {
226                                         *blen = scnprintf(bptr,bmax,"%s",
227                                                           names[idx]);
228                                         ret = 0;
229                                         break;
230                                 }
231                         }
232                 }
233         } while(0); LOCK_GIVE(cptr->hdw->big_lock);
234         return ret;
235 }
236
237
238 /* Return V4L ID for this control or zero if none */
239 int pvr2_ctrl_get_v4lid(struct pvr2_ctrl *cptr)
240 {
241         if (!cptr) return 0;
242         return cptr->info->v4l_id;
243 }
244
245
246 unsigned int pvr2_ctrl_get_v4lflags(struct pvr2_ctrl *cptr)
247 {
248         unsigned int flags = 0;
249
250         if (cptr->info->get_v4lflags) {
251                 flags = cptr->info->get_v4lflags(cptr);
252         }
253
254         if (cptr->info->set_value) {
255                 flags &= ~V4L2_CTRL_FLAG_READ_ONLY;
256         } else {
257                 flags |= V4L2_CTRL_FLAG_READ_ONLY;
258         }
259
260         return flags;
261 }
262
263
264 /* Return true if control is writable */
265 int pvr2_ctrl_is_writable(struct pvr2_ctrl *cptr)
266 {
267         if (!cptr) return 0;
268         return cptr->info->set_value != NULL;
269 }
270
271
272 /* Return true if control has custom symbolic representation */
273 int pvr2_ctrl_has_custom_symbols(struct pvr2_ctrl *cptr)
274 {
275         if (!cptr) return 0;
276         if (!cptr->info->val_to_sym) return 0;
277         if (!cptr->info->sym_to_val) return 0;
278         return !0;
279 }
280
281
282 /* Convert a given mask/val to a custom symbolic value */
283 int pvr2_ctrl_custom_value_to_sym(struct pvr2_ctrl *cptr,
284                                   int mask,int val,
285                                   char *buf,unsigned int maxlen,
286                                   unsigned int *len)
287 {
288         if (!cptr) return -EINVAL;
289         if (!cptr->info->val_to_sym) return -EINVAL;
290         return cptr->info->val_to_sym(cptr,mask,val,buf,maxlen,len);
291 }
292
293
294 /* Convert a symbolic value to a mask/value pair */
295 int pvr2_ctrl_custom_sym_to_value(struct pvr2_ctrl *cptr,
296                                   const char *buf,unsigned int len,
297                                   int *maskptr,int *valptr)
298 {
299         if (!cptr) return -EINVAL;
300         if (!cptr->info->sym_to_val) return -EINVAL;
301         return cptr->info->sym_to_val(cptr,buf,len,maskptr,valptr);
302 }
303
304
305 static unsigned int gen_bitmask_string(int msk,int val,int msk_only,
306                                        const char **names,
307                                        char *ptr,unsigned int len)
308 {
309         unsigned int idx;
310         long sm,um;
311         int spcFl;
312         unsigned int uc,cnt;
313         const char *idStr;
314
315         spcFl = 0;
316         uc = 0;
317         um = 0;
318         for (idx = 0, sm = 1; msk; idx++, sm <<= 1) {
319                 if (sm & msk) {
320                         msk &= ~sm;
321                         idStr = names[idx];
322                         if (idStr) {
323                                 cnt = scnprintf(ptr,len,"%s%s%s",
324                                                 (spcFl ? " " : ""),
325                                                 (msk_only ? "" :
326                                                  ((val & sm) ? "+" : "-")),
327                                                 idStr);
328                                 ptr += cnt; len -= cnt; uc += cnt;
329                                 spcFl = !0;
330                         } else {
331                                 um |= sm;
332                         }
333                 }
334         }
335         if (um) {
336                 if (msk_only) {
337                         cnt = scnprintf(ptr,len,"%s0x%lx",
338                                         (spcFl ? " " : ""),
339                                         um);
340                         ptr += cnt; len -= cnt; uc += cnt;
341                         spcFl = !0;
342                 } else if (um & val) {
343                         cnt = scnprintf(ptr,len,"%s+0x%lx",
344                                         (spcFl ? " " : ""),
345                                         um & val);
346                         ptr += cnt; len -= cnt; uc += cnt;
347                         spcFl = !0;
348                 } else if (um & ~val) {
349                         cnt = scnprintf(ptr,len,"%s+0x%lx",
350                                         (spcFl ? " " : ""),
351                                         um & ~val);
352                         ptr += cnt; len -= cnt; uc += cnt;
353                         spcFl = !0;
354                 }
355         }
356         return uc;
357 }
358
359
360 static const char *boolNames[] = {
361         "false",
362         "true",
363         "no",
364         "yes",
365 };
366
367
368 static int parse_token(const char *ptr,unsigned int len,
369                        int *valptr,
370                        const char **names,unsigned int namecnt)
371 {
372         char buf[33];
373         unsigned int slen;
374         unsigned int idx;
375         int negfl;
376         char *p2;
377         *valptr = 0;
378         if (!names) namecnt = 0;
379         for (idx = 0; idx < namecnt; idx++) {
380                 if (!names[idx]) continue;
381                 slen = strlen(names[idx]);
382                 if (slen != len) continue;
383                 if (memcmp(names[idx],ptr,slen)) continue;
384                 *valptr = idx;
385                 return 0;
386         }
387         negfl = 0;
388         if ((*ptr == '-') || (*ptr == '+')) {
389                 negfl = (*ptr == '-');
390                 ptr++; len--;
391         }
392         if (len >= sizeof(buf)) return -EINVAL;
393         memcpy(buf,ptr,len);
394         buf[len] = 0;
395         *valptr = simple_strtol(buf,&p2,0);
396         if (negfl) *valptr = -(*valptr);
397         if (*p2) return -EINVAL;
398         return 1;
399 }
400
401
402 static int parse_mtoken(const char *ptr,unsigned int len,
403                         int *valptr,
404                         const char **names,int valid_bits)
405 {
406         char buf[33];
407         unsigned int slen;
408         unsigned int idx;
409         char *p2;
410         int msk;
411         *valptr = 0;
412         for (idx = 0, msk = 1; valid_bits; idx++, msk <<= 1) {
413                 if (!(msk & valid_bits)) continue;
414                 valid_bits &= ~msk;
415                 if (!names[idx]) continue;
416                 slen = strlen(names[idx]);
417                 if (slen != len) continue;
418                 if (memcmp(names[idx],ptr,slen)) continue;
419                 *valptr = msk;
420                 return 0;
421         }
422         if (len >= sizeof(buf)) return -EINVAL;
423         memcpy(buf,ptr,len);
424         buf[len] = 0;
425         *valptr = simple_strtol(buf,&p2,0);
426         if (*p2) return -EINVAL;
427         return 0;
428 }
429
430
431 static int parse_tlist(const char *ptr,unsigned int len,
432                        int *maskptr,int *valptr,
433                        const char **names,int valid_bits)
434 {
435         unsigned int cnt;
436         int mask,val,kv,mode,ret;
437         mask = 0;
438         val = 0;
439         ret = 0;
440         while (len) {
441                 cnt = 0;
442                 while ((cnt < len) &&
443                        ((ptr[cnt] <= 32) ||
444                         (ptr[cnt] >= 127))) cnt++;
445                 ptr += cnt;
446                 len -= cnt;
447                 mode = 0;
448                 if ((*ptr == '-') || (*ptr == '+')) {
449                         mode = (*ptr == '-') ? -1 : 1;
450                         ptr++;
451                         len--;
452                 }
453                 cnt = 0;
454                 while (cnt < len) {
455                         if (ptr[cnt] <= 32) break;
456                         if (ptr[cnt] >= 127) break;
457                         cnt++;
458                 }
459                 if (!cnt) break;
460                 if (parse_mtoken(ptr,cnt,&kv,names,valid_bits)) {
461                         ret = -EINVAL;
462                         break;
463                 }
464                 ptr += cnt;
465                 len -= cnt;
466                 switch (mode) {
467                 case 0:
468                         mask = valid_bits;
469                         val |= kv;
470                         break;
471                 case -1:
472                         mask |= kv;
473                         val &= ~kv;
474                         break;
475                 case 1:
476                         mask |= kv;
477                         val |= kv;
478                         break;
479                 default:
480                         break;
481                 }
482         }
483         *maskptr = mask;
484         *valptr = val;
485         return ret;
486 }
487
488
489 /* Convert a symbolic value to a mask/value pair */
490 int pvr2_ctrl_sym_to_value(struct pvr2_ctrl *cptr,
491                            const char *ptr,unsigned int len,
492                            int *maskptr,int *valptr)
493 {
494         int ret = -EINVAL;
495         unsigned int cnt;
496
497         *maskptr = 0;
498         *valptr = 0;
499
500         cnt = 0;
501         while ((cnt < len) && ((ptr[cnt] <= 32) || (ptr[cnt] >= 127))) cnt++;
502         len -= cnt; ptr += cnt;
503         cnt = 0;
504         while ((cnt < len) && ((ptr[len-(cnt+1)] <= 32) ||
505                                (ptr[len-(cnt+1)] >= 127))) cnt++;
506         len -= cnt;
507
508         if (!len) return -EINVAL;
509
510         LOCK_TAKE(cptr->hdw->big_lock); do {
511                 if (cptr->info->type == pvr2_ctl_int) {
512                         ret = parse_token(ptr,len,valptr,NULL,0);
513                         if (ret >= 0) {
514                                 ret = pvr2_ctrl_range_check(cptr,*valptr);
515                         }
516                         if (maskptr) *maskptr = ~0;
517                 } else if (cptr->info->type == pvr2_ctl_bool) {
518                         ret = parse_token(ptr,len,valptr,boolNames,
519                                           ARRAY_SIZE(boolNames));
520                         if (ret == 1) {
521                                 *valptr = *valptr ? !0 : 0;
522                         } else if (ret == 0) {
523                                 *valptr = (*valptr & 1) ? !0 : 0;
524                         }
525                         if (maskptr) *maskptr = 1;
526                 } else if (cptr->info->type == pvr2_ctl_enum) {
527                         ret = parse_token(
528                                 ptr,len,valptr,
529                                 cptr->info->def.type_enum.value_names,
530                                 cptr->info->def.type_enum.count);
531                         if (ret >= 0) {
532                                 ret = pvr2_ctrl_range_check(cptr,*valptr);
533                         }
534                         if (maskptr) *maskptr = ~0;
535                 } else if (cptr->info->type == pvr2_ctl_bitmask) {
536                         ret = parse_tlist(
537                                 ptr,len,maskptr,valptr,
538                                 cptr->info->def.type_bitmask.bit_names,
539                                 cptr->info->def.type_bitmask.valid_bits);
540                 }
541         } while(0); LOCK_GIVE(cptr->hdw->big_lock);
542         return ret;
543 }
544
545
546 /* Convert a given mask/val to a symbolic value */
547 int pvr2_ctrl_value_to_sym_internal(struct pvr2_ctrl *cptr,
548                                     int mask,int val,
549                                     char *buf,unsigned int maxlen,
550                                     unsigned int *len)
551 {
552         int ret = -EINVAL;
553
554         *len = 0;
555         if (cptr->info->type == pvr2_ctl_int) {
556                 *len = scnprintf(buf,maxlen,"%d",val);
557                 ret = 0;
558         } else if (cptr->info->type == pvr2_ctl_bool) {
559                 *len = scnprintf(buf,maxlen,"%s",val ? "true" : "false");
560                 ret = 0;
561         } else if (cptr->info->type == pvr2_ctl_enum) {
562                 const char **names;
563                 names = cptr->info->def.type_enum.value_names;
564                 if ((val >= 0) &&
565                     (val < cptr->info->def.type_enum.count)) {
566                         if (names[val]) {
567                                 *len = scnprintf(
568                                         buf,maxlen,"%s",
569                                         names[val]);
570                         } else {
571                                 *len = 0;
572                         }
573                         ret = 0;
574                 }
575         } else if (cptr->info->type == pvr2_ctl_bitmask) {
576                 *len = gen_bitmask_string(
577                         val & mask & cptr->info->def.type_bitmask.valid_bits,
578                         ~0,!0,
579                         cptr->info->def.type_bitmask.bit_names,
580                         buf,maxlen);
581         }
582         return ret;
583 }
584
585
586 /* Convert a given mask/val to a symbolic value */
587 int pvr2_ctrl_value_to_sym(struct pvr2_ctrl *cptr,
588                            int mask,int val,
589                            char *buf,unsigned int maxlen,
590                            unsigned int *len)
591 {
592         int ret;
593         LOCK_TAKE(cptr->hdw->big_lock); do {
594                 ret = pvr2_ctrl_value_to_sym_internal(cptr,mask,val,
595                                                       buf,maxlen,len);
596         } while(0); LOCK_GIVE(cptr->hdw->big_lock);
597         return ret;
598 }
599
600
601 /*
602   Stuff for Emacs to see, in order to encourage consistent editing style:
603   *** Local Variables: ***
604   *** mode: c ***
605   *** fill-column: 75 ***
606   *** tab-width: 8 ***
607   *** c-basic-offset: 8 ***
608   *** End: ***
609   */