1
2
3
4
5
6
7
8
9
10#include "ivtv-driver.h"
11#include "ivtv-cards.h"
12#include "ivtv-gpio.h"
13#include "tuner-xc2028.h"
14#include <media/tuner.h>
15#include <media/v4l2-ctrls.h>
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90#define IVTV_REG_GPIO_IN 0x9008
91#define IVTV_REG_GPIO_OUT 0x900c
92#define IVTV_REG_GPIO_DIR 0x9020
93
94void ivtv_reset_ir_gpio(struct ivtv *itv)
95{
96 int curdir, curout;
97
98 if (itv->card->type != IVTV_CARD_PVR_150)
99 return;
100 IVTV_DEBUG_INFO("Resetting PVR150 IR\n");
101 curout = read_reg(IVTV_REG_GPIO_OUT);
102 curdir = read_reg(IVTV_REG_GPIO_DIR);
103 curdir |= 0x80;
104 write_reg(curdir, IVTV_REG_GPIO_DIR);
105 curout = (curout & ~0xF) | 1;
106 write_reg(curout, IVTV_REG_GPIO_OUT);
107
108 schedule_timeout_interruptible(msecs_to_jiffies(1));
109 curout |= 2;
110 write_reg(curout, IVTV_REG_GPIO_OUT);
111 curdir &= ~0x80;
112 write_reg(curdir, IVTV_REG_GPIO_DIR);
113}
114
115
116int ivtv_reset_tuner_gpio(void *dev, int component, int cmd, int value)
117{
118 struct i2c_algo_bit_data *algo = dev;
119 struct ivtv *itv = algo->data;
120 u32 curout;
121
122 if (cmd != XC2028_TUNER_RESET)
123 return 0;
124 IVTV_DEBUG_INFO("Resetting tuner\n");
125 curout = read_reg(IVTV_REG_GPIO_OUT);
126 curout &= ~(1 << itv->card->xceive_pin);
127 write_reg(curout, IVTV_REG_GPIO_OUT);
128 schedule_timeout_interruptible(msecs_to_jiffies(1));
129
130 curout |= 1 << itv->card->xceive_pin;
131 write_reg(curout, IVTV_REG_GPIO_OUT);
132 schedule_timeout_interruptible(msecs_to_jiffies(1));
133 return 0;
134}
135
136static inline struct ivtv *sd_to_ivtv(struct v4l2_subdev *sd)
137{
138 return container_of(sd, struct ivtv, sd_gpio);
139}
140
141static inline struct v4l2_subdev *to_sd(struct v4l2_ctrl *ctrl)
142{
143 return &container_of(ctrl->handler, struct ivtv, hdl_gpio)->sd_gpio;
144}
145
146static int subdev_s_clock_freq(struct v4l2_subdev *sd, u32 freq)
147{
148 struct ivtv *itv = sd_to_ivtv(sd);
149 u16 mask, data;
150
151 mask = itv->card->gpio_audio_freq.mask;
152 switch (freq) {
153 case 32000:
154 data = itv->card->gpio_audio_freq.f32000;
155 break;
156 case 44100:
157 data = itv->card->gpio_audio_freq.f44100;
158 break;
159 case 48000:
160 default:
161 data = itv->card->gpio_audio_freq.f48000;
162 break;
163 }
164 if (mask)
165 write_reg((read_reg(IVTV_REG_GPIO_OUT) & ~mask) | (data & mask), IVTV_REG_GPIO_OUT);
166 return 0;
167}
168
169static int subdev_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
170{
171 struct ivtv *itv = sd_to_ivtv(sd);
172 u16 mask;
173
174 mask = itv->card->gpio_audio_detect.mask;
175 if (mask == 0 || (read_reg(IVTV_REG_GPIO_IN) & mask))
176 vt->rxsubchans = V4L2_TUNER_SUB_STEREO |
177 V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
178 else
179 vt->rxsubchans = V4L2_TUNER_SUB_MONO;
180 return 0;
181}
182
183static int subdev_s_tuner(struct v4l2_subdev *sd, const struct v4l2_tuner *vt)
184{
185 struct ivtv *itv = sd_to_ivtv(sd);
186 u16 mask, data;
187
188 mask = itv->card->gpio_audio_mode.mask;
189 switch (vt->audmode) {
190 case V4L2_TUNER_MODE_LANG1:
191 data = itv->card->gpio_audio_mode.lang1;
192 break;
193 case V4L2_TUNER_MODE_LANG2:
194 data = itv->card->gpio_audio_mode.lang2;
195 break;
196 case V4L2_TUNER_MODE_MONO:
197 data = itv->card->gpio_audio_mode.mono;
198 break;
199 case V4L2_TUNER_MODE_STEREO:
200 case V4L2_TUNER_MODE_LANG1_LANG2:
201 default:
202 data = itv->card->gpio_audio_mode.stereo;
203 break;
204 }
205 if (mask)
206 write_reg((read_reg(IVTV_REG_GPIO_OUT) & ~mask) | (data & mask), IVTV_REG_GPIO_OUT);
207 return 0;
208}
209
210static int subdev_s_radio(struct v4l2_subdev *sd)
211{
212 struct ivtv *itv = sd_to_ivtv(sd);
213 u16 mask, data;
214
215 mask = itv->card->gpio_audio_input.mask;
216 data = itv->card->gpio_audio_input.radio;
217 if (mask)
218 write_reg((read_reg(IVTV_REG_GPIO_OUT) & ~mask) | (data & mask), IVTV_REG_GPIO_OUT);
219 return 0;
220}
221
222static int subdev_s_audio_routing(struct v4l2_subdev *sd,
223 u32 input, u32 output, u32 config)
224{
225 struct ivtv *itv = sd_to_ivtv(sd);
226 u16 mask, data;
227
228 if (input > 2)
229 return -EINVAL;
230 mask = itv->card->gpio_audio_input.mask;
231 switch (input) {
232 case 0:
233 data = itv->card->gpio_audio_input.tuner;
234 break;
235 case 1:
236 data = itv->card->gpio_audio_input.linein;
237 break;
238 case 2:
239 default:
240 data = itv->card->gpio_audio_input.radio;
241 break;
242 }
243 if (mask)
244 write_reg((read_reg(IVTV_REG_GPIO_OUT) & ~mask) | (data & mask), IVTV_REG_GPIO_OUT);
245 return 0;
246}
247
248static int subdev_s_ctrl(struct v4l2_ctrl *ctrl)
249{
250 struct v4l2_subdev *sd = to_sd(ctrl);
251 struct ivtv *itv = sd_to_ivtv(sd);
252 u16 mask, data;
253
254 switch (ctrl->id) {
255 case V4L2_CID_AUDIO_MUTE:
256 mask = itv->card->gpio_audio_mute.mask;
257 data = ctrl->val ? itv->card->gpio_audio_mute.mute : 0;
258 if (mask)
259 write_reg((read_reg(IVTV_REG_GPIO_OUT) & ~mask) |
260 (data & mask), IVTV_REG_GPIO_OUT);
261 return 0;
262 }
263 return -EINVAL;
264}
265
266
267static int subdev_log_status(struct v4l2_subdev *sd)
268{
269 struct ivtv *itv = sd_to_ivtv(sd);
270
271 IVTV_INFO("GPIO status: DIR=0x%04x OUT=0x%04x IN=0x%04x\n",
272 read_reg(IVTV_REG_GPIO_DIR), read_reg(IVTV_REG_GPIO_OUT),
273 read_reg(IVTV_REG_GPIO_IN));
274 v4l2_ctrl_handler_log_status(&itv->hdl_gpio, sd->name);
275 return 0;
276}
277
278static int subdev_s_video_routing(struct v4l2_subdev *sd,
279 u32 input, u32 output, u32 config)
280{
281 struct ivtv *itv = sd_to_ivtv(sd);
282 u16 mask, data;
283
284 if (input > 2)
285 return -EINVAL;
286 mask = itv->card->gpio_video_input.mask;
287 if (input == 0)
288 data = itv->card->gpio_video_input.tuner;
289 else if (input == 1)
290 data = itv->card->gpio_video_input.composite;
291 else
292 data = itv->card->gpio_video_input.svideo;
293 if (mask)
294 write_reg((read_reg(IVTV_REG_GPIO_OUT) & ~mask) | (data & mask), IVTV_REG_GPIO_OUT);
295 return 0;
296}
297
298static const struct v4l2_ctrl_ops gpio_ctrl_ops = {
299 .s_ctrl = subdev_s_ctrl,
300};
301
302static const struct v4l2_subdev_core_ops subdev_core_ops = {
303 .log_status = subdev_log_status,
304};
305
306static const struct v4l2_subdev_tuner_ops subdev_tuner_ops = {
307 .s_radio = subdev_s_radio,
308 .g_tuner = subdev_g_tuner,
309 .s_tuner = subdev_s_tuner,
310};
311
312static const struct v4l2_subdev_audio_ops subdev_audio_ops = {
313 .s_clock_freq = subdev_s_clock_freq,
314 .s_routing = subdev_s_audio_routing,
315};
316
317static const struct v4l2_subdev_video_ops subdev_video_ops = {
318 .s_routing = subdev_s_video_routing,
319};
320
321static const struct v4l2_subdev_ops subdev_ops = {
322 .core = &subdev_core_ops,
323 .tuner = &subdev_tuner_ops,
324 .audio = &subdev_audio_ops,
325 .video = &subdev_video_ops,
326};
327
328int ivtv_gpio_init(struct ivtv *itv)
329{
330 u16 pin = 0;
331
332 if (itv->card->xceive_pin)
333 pin = 1 << itv->card->xceive_pin;
334
335 if ((itv->card->gpio_init.direction | pin) == 0)
336 return 0;
337
338 IVTV_DEBUG_INFO("GPIO initial dir: %08x out: %08x\n",
339 read_reg(IVTV_REG_GPIO_DIR), read_reg(IVTV_REG_GPIO_OUT));
340
341
342 write_reg(itv->card->gpio_init.initial_value | pin, IVTV_REG_GPIO_OUT);
343 write_reg(itv->card->gpio_init.direction | pin, IVTV_REG_GPIO_DIR);
344 v4l2_subdev_init(&itv->sd_gpio, &subdev_ops);
345 snprintf(itv->sd_gpio.name, sizeof(itv->sd_gpio.name), "%s-gpio", itv->v4l2_dev.name);
346 itv->sd_gpio.grp_id = IVTV_HW_GPIO;
347 v4l2_ctrl_handler_init(&itv->hdl_gpio, 1);
348 v4l2_ctrl_new_std(&itv->hdl_gpio, &gpio_ctrl_ops,
349 V4L2_CID_AUDIO_MUTE, 0, 1, 1, 0);
350 if (itv->hdl_gpio.error)
351 return itv->hdl_gpio.error;
352 itv->sd_gpio.ctrl_handler = &itv->hdl_gpio;
353 v4l2_ctrl_handler_setup(&itv->hdl_gpio);
354 return v4l2_device_register_subdev(&itv->v4l2_dev, &itv->sd_gpio);
355}
356
