Commit | Line | Data |
---|---|---|
d855497e MI |
1 | /* |
2 | * | |
d855497e MI |
3 | * |
4 | * Copyright (C) 2005 Mike Isely <isely@pobox.com> | |
5 | * Copyright (C) 2004 Aurelien Alleaume <slts@free.fr> | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License as published by | |
9 | * the Free Software Foundation; either version 2 of the License | |
10 | * | |
11 | * This program is distributed in the hope that it will be useful, | |
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
14 | * GNU General Public License for more details. | |
15 | * | |
16 | * You should have received a copy of the GNU General Public License | |
17 | * along with this program; if not, write to the Free Software | |
18 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
19 | * | |
20 | */ | |
21 | ||
22 | /* | |
23 | ||
24 | This source file is specifically designed to interface with the | |
25 | wm8775. | |
26 | ||
27 | */ | |
28 | ||
29 | #include "pvrusb2-wm8775.h" | |
30 | #include "pvrusb2-i2c-cmd-v4l2.h" | |
31 | ||
32 | ||
33 | #include "pvrusb2-hdw-internal.h" | |
34 | #include "pvrusb2-debug.h" | |
35 | #include <linux/videodev2.h> | |
36 | #include <media/v4l2-common.h> | |
37 | #include <linux/errno.h> | |
38 | #include <linux/slab.h> | |
39 | ||
5f6dae80 MI |
40 | |
41 | ||
d855497e MI |
42 | struct pvr2_v4l_wm8775 { |
43 | struct pvr2_i2c_handler handler; | |
44 | struct pvr2_i2c_client *client; | |
45 | struct pvr2_hdw *hdw; | |
46 | unsigned long stale_mask; | |
47 | }; | |
48 | ||
49 | ||
50 | static void set_input(struct pvr2_v4l_wm8775 *ctxt) | |
51 | { | |
52 | struct v4l2_routing route; | |
53 | struct pvr2_hdw *hdw = ctxt->hdw; | |
d855497e MI |
54 | |
55 | memset(&route,0,sizeof(route)); | |
56 | ||
20832300 MI |
57 | switch(hdw->input_val) { |
58 | case PVR2_CVAL_INPUT_RADIO: | |
59 | route.input = 1; | |
60 | break; | |
61 | default: | |
62 | /* All other cases just use the second input */ | |
63 | route.input = 2; | |
64 | break; | |
65 | } | |
66 | pvr2_trace(PVR2_TRACE_CHIPS,"i2c wm8775 set_input(val=%d route=0x%x)", | |
67 | hdw->input_val,route.input); | |
d855497e | 68 | |
d855497e MI |
69 | pvr2_i2c_client_cmd(ctxt->client,VIDIOC_INT_S_AUDIO_ROUTING,&route); |
70 | } | |
71 | ||
72 | static int check_input(struct pvr2_v4l_wm8775 *ctxt) | |
73 | { | |
74 | struct pvr2_hdw *hdw = ctxt->hdw; | |
75 | return hdw->input_dirty != 0; | |
76 | } | |
77 | ||
78 | ||
79 | struct pvr2_v4l_wm8775_ops { | |
80 | void (*update)(struct pvr2_v4l_wm8775 *); | |
81 | int (*check)(struct pvr2_v4l_wm8775 *); | |
82 | }; | |
83 | ||
84 | ||
85 | static const struct pvr2_v4l_wm8775_ops wm8775_ops[] = { | |
86 | { .update = set_input, .check = check_input}, | |
87 | }; | |
88 | ||
89 | ||
90 | static unsigned int wm8775_describe(struct pvr2_v4l_wm8775 *ctxt, | |
91 | char *buf,unsigned int cnt) | |
92 | { | |
93 | return scnprintf(buf,cnt,"handler: pvrusb2-wm8775"); | |
94 | } | |
95 | ||
96 | ||
97 | static void wm8775_detach(struct pvr2_v4l_wm8775 *ctxt) | |
98 | { | |
a0fd1cb1 | 99 | ctxt->client->handler = NULL; |
d855497e MI |
100 | kfree(ctxt); |
101 | } | |
102 | ||
103 | ||
104 | static int wm8775_check(struct pvr2_v4l_wm8775 *ctxt) | |
105 | { | |
106 | unsigned long msk; | |
107 | unsigned int idx; | |
108 | ||
eca8ebfc | 109 | for (idx = 0; idx < ARRAY_SIZE(wm8775_ops); idx++) { |
d855497e MI |
110 | msk = 1 << idx; |
111 | if (ctxt->stale_mask & msk) continue; | |
112 | if (wm8775_ops[idx].check(ctxt)) { | |
113 | ctxt->stale_mask |= msk; | |
114 | } | |
115 | } | |
116 | return ctxt->stale_mask != 0; | |
117 | } | |
118 | ||
119 | ||
120 | static void wm8775_update(struct pvr2_v4l_wm8775 *ctxt) | |
121 | { | |
122 | unsigned long msk; | |
123 | unsigned int idx; | |
124 | ||
eca8ebfc | 125 | for (idx = 0; idx < ARRAY_SIZE(wm8775_ops); idx++) { |
d855497e MI |
126 | msk = 1 << idx; |
127 | if (!(ctxt->stale_mask & msk)) continue; | |
128 | ctxt->stale_mask &= ~msk; | |
129 | wm8775_ops[idx].update(ctxt); | |
130 | } | |
131 | } | |
132 | ||
133 | ||
c5a69d57 | 134 | static const struct pvr2_i2c_handler_functions hfuncs = { |
d855497e MI |
135 | .detach = (void (*)(void *))wm8775_detach, |
136 | .check = (int (*)(void *))wm8775_check, | |
137 | .update = (void (*)(void *))wm8775_update, | |
138 | .describe = (unsigned int (*)(void *,char *,unsigned int))wm8775_describe, | |
139 | }; | |
140 | ||
141 | ||
142 | int pvr2_i2c_wm8775_setup(struct pvr2_hdw *hdw,struct pvr2_i2c_client *cp) | |
143 | { | |
144 | struct pvr2_v4l_wm8775 *ctxt; | |
145 | ||
146 | if (cp->handler) return 0; | |
147 | ||
ca545f7c | 148 | ctxt = kzalloc(sizeof(*ctxt),GFP_KERNEL); |
d855497e | 149 | if (!ctxt) return 0; |
d855497e MI |
150 | |
151 | ctxt->handler.func_data = ctxt; | |
152 | ctxt->handler.func_table = &hfuncs; | |
153 | ctxt->client = cp; | |
154 | ctxt->hdw = hdw; | |
eca8ebfc | 155 | ctxt->stale_mask = (1 << ARRAY_SIZE(wm8775_ops)) - 1; |
d855497e MI |
156 | cp->handler = &ctxt->handler; |
157 | pvr2_trace(PVR2_TRACE_CHIPS,"i2c 0x%x wm8775 V4L2 handler set up", | |
158 | cp->client->addr); | |
159 | return !0; | |
160 | } | |
161 | ||
162 | ||
4ecbc28d | 163 | void pvr2_wm8775_subdev_update(struct pvr2_hdw *hdw, struct v4l2_subdev *sd) |
5f6dae80 MI |
164 | { |
165 | if (hdw->input_dirty) { | |
166 | struct v4l2_routing route; | |
167 | ||
168 | memset(&route, 0, sizeof(route)); | |
169 | ||
170 | switch (hdw->input_val) { | |
171 | case PVR2_CVAL_INPUT_RADIO: | |
172 | route.input = 1; | |
173 | break; | |
174 | default: | |
175 | /* All other cases just use the second input */ | |
176 | route.input = 2; | |
177 | break; | |
178 | } | |
179 | pvr2_trace(PVR2_TRACE_CHIPS, "subdev wm8775" | |
180 | " set_input(val=%d route=0x%x)", | |
181 | hdw->input_val, route.input); | |
182 | ||
183 | sd->ops->audio->s_routing(sd, &route); | |
184 | } | |
185 | } | |
186 | ||
d855497e MI |
187 | |
188 | ||
189 | /* | |
190 | Stuff for Emacs to see, in order to encourage consistent editing style: | |
191 | *** Local Variables: *** | |
192 | *** mode: c *** | |
193 | *** fill-column: 70 *** | |
194 | *** tab-width: 8 *** | |
195 | *** c-basic-offset: 8 *** | |
196 | *** End: *** | |
197 | */ |