1
2
3
4
5
6
7
8
9
10
11
12
13
14#include "saa7134.h"
15#include "saa7134-reg.h"
16
17#include <linux/module.h>
18#include <linux/kernel.h>
19#include <linux/init.h>
20#include <linux/spinlock.h>
21#include <linux/wait.h>
22#include <linux/list.h>
23#include <linux/slab.h>
24#include <linux/time.h>
25#include <linux/mm.h>
26#include <linux/usb.h>
27#include <linux/i2c.h>
28#include <asm/byteorder.h>
29#include <media/v4l2-common.h>
30#include <media/v4l2-device.h>
31#include <media/v4l2-subdev.h>
32
33#include "go7007-priv.h"
34
35
36
37enum hpi_address {
38 HPI_ADDR_VIDEO_BUFFER = 0xe4,
39 HPI_ADDR_INIT_BUFFER = 0xea,
40 HPI_ADDR_INTR_RET_VALUE = 0xee,
41 HPI_ADDR_INTR_RET_DATA = 0xec,
42 HPI_ADDR_INTR_STATUS = 0xf4,
43 HPI_ADDR_INTR_WR_PARAM = 0xf6,
44 HPI_ADDR_INTR_WR_INDEX = 0xf8,
45};
46
47enum gpio_command {
48 GPIO_COMMAND_RESET = 0x00,
49 GPIO_COMMAND_REQ1 = 0x04,
50 GPIO_COMMAND_WRITE = 0x20,
51 GPIO_COMMAND_REQ2 = 0x24,
52 GPIO_COMMAND_READ = 0x80,
53 GPIO_COMMAND_VIDEO = 0x84,
54 GPIO_COMMAND_IDLE = 0xA0,
55 GPIO_COMMAND_ADDR = 0xA4,
56};
57
58struct saa7134_go7007 {
59 struct v4l2_subdev sd;
60 struct saa7134_dev *dev;
61 u8 *top;
62 u8 *bottom;
63 dma_addr_t top_dma;
64 dma_addr_t bottom_dma;
65};
66
67static inline struct saa7134_go7007 *to_state(struct v4l2_subdev *sd)
68{
69 return container_of(sd, struct saa7134_go7007, sd);
70}
71
72static const struct go7007_board_info board_voyager = {
73 .flags = 0,
74 .sensor_flags = GO7007_SENSOR_656 |
75 GO7007_SENSOR_VALID_ENABLE |
76 GO7007_SENSOR_TV |
77 GO7007_SENSOR_VBI,
78 .audio_flags = GO7007_AUDIO_I2S_MODE_1 |
79 GO7007_AUDIO_WORD_16,
80 .audio_rate = 48000,
81 .audio_bclk_div = 8,
82 .audio_main_div = 2,
83 .hpi_buffer_cap = 7,
84 .num_inputs = 1,
85 .inputs = {
86 {
87 .name = "SAA7134",
88 },
89 },
90};
91
92
93
94static int gpio_write(struct saa7134_dev *dev, u8 addr, u16 data)
95{
96 saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);
97
98
99 saa_writeb(SAA7134_GPIO_GPSTATUS0, addr);
100 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR);
101 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
102
103
104 saa_writeb(SAA7134_GPIO_GPSTATUS0, data & 0xff);
105 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE);
106 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
107
108
109 saa_writeb(SAA7134_GPIO_GPSTATUS0, data >> 8);
110 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE);
111 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
112
113 return 0;
114}
115
116static int gpio_read(struct saa7134_dev *dev, u8 addr, u16 *data)
117{
118 saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);
119
120
121 saa_writeb(SAA7134_GPIO_GPSTATUS0, addr);
122 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR);
123 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
124
125 saa_writeb(SAA7134_GPIO_GPMODE0, 0x00);
126
127
128 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_READ);
129 saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
130 saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
131 *data = saa_readb(SAA7134_GPIO_GPSTATUS0);
132 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
133
134
135 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_READ);
136 saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
137 saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
138 *data |= saa_readb(SAA7134_GPIO_GPSTATUS0) << 8;
139 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
140
141 return 0;
142}
143
144static int saa7134_go7007_interface_reset(struct go7007 *go)
145{
146 struct saa7134_go7007 *saa = go->hpi_context;
147 struct saa7134_dev *dev = saa->dev;
148 u16 intr_val, intr_data;
149 int count = 20;
150
151 saa_clearb(SAA7134_TS_PARALLEL, 0x80);
152 saa_writeb(SAA7134_GPIO_GPMODE2, 0xa4);
153 saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);
154
155 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1);
156 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_RESET);
157 msleep(1);
158 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1);
159 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ2);
160 msleep(10);
161
162 saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
163 saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
164
165 saa_readb(SAA7134_GPIO_GPSTATUS2);
166
167
168
169 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1);
170 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ2);
171
172 do {
173 saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
174 saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
175 saa_readb(SAA7134_GPIO_GPSTATUS2);
176
177 } while (--count > 0);
178
179
180 if (go7007_read_interrupt(go, &intr_val, &intr_data) < 0 ||
181 (intr_val & ~0x1) != 0x55aa) {
182 pr_err("saa7134-go7007: unable to reset the GO7007\n");
183 return -1;
184 }
185 return 0;
186}
187
188static int saa7134_go7007_write_interrupt(struct go7007 *go, int addr, int data)
189{
190 struct saa7134_go7007 *saa = go->hpi_context;
191 struct saa7134_dev *dev = saa->dev;
192 int i;
193 u16 status_reg;
194
195#ifdef GO7007_HPI_DEBUG
196 pr_debug("saa7134-go7007: WriteInterrupt: %04x %04x\n", addr, data);
197#endif
198
199 for (i = 0; i < 100; ++i) {
200 gpio_read(dev, HPI_ADDR_INTR_STATUS, &status_reg);
201 if (!(status_reg & 0x0010))
202 break;
203 msleep(10);
204 }
205 if (i == 100) {
206 pr_err("saa7134-go7007: device is hung, status reg = 0x%04x\n",
207 status_reg);
208 return -1;
209 }
210 gpio_write(dev, HPI_ADDR_INTR_WR_PARAM, data);
211 gpio_write(dev, HPI_ADDR_INTR_WR_INDEX, addr);
212
213 return 0;
214}
215
216static int saa7134_go7007_read_interrupt(struct go7007 *go)
217{
218 struct saa7134_go7007 *saa = go->hpi_context;
219 struct saa7134_dev *dev = saa->dev;
220
221
222 go->interrupt_available = 1;
223 gpio_read(dev, HPI_ADDR_INTR_RET_VALUE, &go->interrupt_value);
224 gpio_read(dev, HPI_ADDR_INTR_RET_DATA, &go->interrupt_data);
225#ifdef GO7007_HPI_DEBUG
226 pr_debug("saa7134-go7007: ReadInterrupt: %04x %04x\n",
227 go->interrupt_value, go->interrupt_data);
228#endif
229 return 0;
230}
231
232static void saa7134_go7007_irq_ts_done(struct saa7134_dev *dev,
233 unsigned long status)
234{
235 struct go7007 *go = video_get_drvdata(dev->empress_dev);
236 struct saa7134_go7007 *saa = go->hpi_context;
237
238 if (!vb2_is_streaming(&go->vidq))
239 return;
240 if (0 != (status & 0x000f0000))
241 pr_debug("saa7134-go7007: irq: lost %ld\n",
242 (status >> 16) & 0x0f);
243 if (status & 0x100000) {
244 dma_sync_single_for_cpu(&dev->pci->dev,
245 saa->bottom_dma, PAGE_SIZE, DMA_FROM_DEVICE);
246 go7007_parse_video_stream(go, saa->bottom, PAGE_SIZE);
247 saa_writel(SAA7134_RS_BA2(5), saa->bottom_dma);
248 } else {
249 dma_sync_single_for_cpu(&dev->pci->dev,
250 saa->top_dma, PAGE_SIZE, DMA_FROM_DEVICE);
251 go7007_parse_video_stream(go, saa->top, PAGE_SIZE);
252 saa_writel(SAA7134_RS_BA1(5), saa->top_dma);
253 }
254}
255
256static int saa7134_go7007_stream_start(struct go7007 *go)
257{
258 struct saa7134_go7007 *saa = go->hpi_context;
259 struct saa7134_dev *dev = saa->dev;
260
261 saa->top_dma = dma_map_page(&dev->pci->dev, virt_to_page(saa->top),
262 0, PAGE_SIZE, DMA_FROM_DEVICE);
263 if (dma_mapping_error(&dev->pci->dev, saa->top_dma))
264 return -ENOMEM;
265 saa->bottom_dma = dma_map_page(&dev->pci->dev,
266 virt_to_page(saa->bottom),
267 0, PAGE_SIZE, DMA_FROM_DEVICE);
268 if (dma_mapping_error(&dev->pci->dev, saa->bottom_dma)) {
269 dma_unmap_page(&dev->pci->dev, saa->top_dma, PAGE_SIZE,
270 DMA_FROM_DEVICE);
271 return -ENOMEM;
272 }
273
274 saa_writel(SAA7134_VIDEO_PORT_CTRL0 >> 2, 0xA300B000);
275 saa_writel(SAA7134_VIDEO_PORT_CTRL4 >> 2, 0x40000200);
276
277
278 saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);
279 saa_writeb(SAA7134_GPIO_GPSTATUS0, HPI_ADDR_VIDEO_BUFFER);
280 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR);
281 saa_writeb(SAA7134_GPIO_GPMODE0, 0x00);
282
283
284 saa_writeb(SAA7134_TS_PARALLEL, 0xe6);
285
286
287 saa_setb(SAA7134_TS_SERIAL1, 0x01);
288 saa_clearb(SAA7134_TS_SERIAL1, 0x01);
289
290
291 saa_writeb(SAA7134_TS_PARALLEL_SERIAL, 128 - 1);
292 saa_writeb(SAA7134_TS_DMA0, ((PAGE_SIZE >> 7) - 1) & 0xff);
293 saa_writeb(SAA7134_TS_DMA1, (PAGE_SIZE >> 15) & 0xff);
294 saa_writeb(SAA7134_TS_DMA2, (PAGE_SIZE >> 31) & 0x3f);
295
296
297 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_VIDEO);
298
299 saa_writel(SAA7134_RS_BA1(5), saa->top_dma);
300 saa_writel(SAA7134_RS_BA2(5), saa->bottom_dma);
301 saa_writel(SAA7134_RS_PITCH(5), 128);
302 saa_writel(SAA7134_RS_CONTROL(5), SAA7134_RS_CONTROL_BURST_MAX);
303
304
305 saa_setl(SAA7134_MAIN_CTRL, SAA7134_MAIN_CTRL_TE5);
306
307
308 saa_setl(SAA7134_IRQ1,
309 SAA7134_IRQ1_INTE_RA2_1 | SAA7134_IRQ1_INTE_RA2_0);
310
311 return 0;
312}
313
314static int saa7134_go7007_stream_stop(struct go7007 *go)
315{
316 struct saa7134_go7007 *saa = go->hpi_context;
317 struct saa7134_dev *dev;
318
319 if (!saa)
320 return -EINVAL;
321 dev = saa->dev;
322 if (!dev)
323 return -EINVAL;
324
325
326 saa_clearl(SAA7134_MAIN_CTRL, SAA7134_MAIN_CTRL_TE5);
327
328
329 saa_clearl(SAA7134_IRQ1,
330 SAA7134_IRQ1_INTE_RA2_1 | SAA7134_IRQ1_INTE_RA2_0);
331
332
333 saa_clearb(SAA7134_TS_PARALLEL, 0x80);
334
335 dma_unmap_page(&dev->pci->dev, saa->top_dma, PAGE_SIZE,
336 DMA_FROM_DEVICE);
337 dma_unmap_page(&dev->pci->dev, saa->bottom_dma, PAGE_SIZE,
338 DMA_FROM_DEVICE);
339
340 return 0;
341}
342
343static int saa7134_go7007_send_firmware(struct go7007 *go, u8 *data, int len)
344{
345 struct saa7134_go7007 *saa = go->hpi_context;
346 struct saa7134_dev *dev = saa->dev;
347 u16 status_reg;
348 int i;
349
350#ifdef GO7007_HPI_DEBUG
351 pr_debug("saa7134-go7007: DownloadBuffer sending %d bytes\n", len);
352#endif
353
354 while (len > 0) {
355 i = len > 64 ? 64 : len;
356 saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);
357 saa_writeb(SAA7134_GPIO_GPSTATUS0, HPI_ADDR_INIT_BUFFER);
358 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR);
359 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
360 while (i-- > 0) {
361 saa_writeb(SAA7134_GPIO_GPSTATUS0, *data);
362 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE);
363 saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE);
364 ++data;
365 --len;
366 }
367 for (i = 0; i < 100; ++i) {
368 gpio_read(dev, HPI_ADDR_INTR_STATUS, &status_reg);
369 if (!(status_reg & 0x0002))
370 break;
371 }
372 if (i == 100) {
373 pr_err("saa7134-go7007: device is hung, status reg = 0x%04x\n",
374 status_reg);
375 return -1;
376 }
377 }
378 return 0;
379}
380
381static const struct go7007_hpi_ops saa7134_go7007_hpi_ops = {
382 .interface_reset = saa7134_go7007_interface_reset,
383 .write_interrupt = saa7134_go7007_write_interrupt,
384 .read_interrupt = saa7134_go7007_read_interrupt,
385 .stream_start = saa7134_go7007_stream_start,
386 .stream_stop = saa7134_go7007_stream_stop,
387 .send_firmware = saa7134_go7007_send_firmware,
388};
389MODULE_FIRMWARE("go7007/go7007tv.bin");
390
391
392
393static int saa7134_go7007_s_std(struct v4l2_subdev *sd, v4l2_std_id norm)
394{
395#if 0
396 struct saa7134_go7007 *saa = to_state(sd);
397 struct saa7134_dev *dev = saa->dev;
398
399 return saa7134_s_std_internal(dev, NULL, norm);
400#else
401 return 0;
402#endif
403}
404
405static const struct v4l2_subdev_video_ops saa7134_go7007_video_ops = {
406 .s_std = saa7134_go7007_s_std,
407};
408
409static const struct v4l2_subdev_ops saa7134_go7007_sd_ops = {
410 .video = &saa7134_go7007_video_ops,
411};
412
413
414
415
416
417
418static int saa7134_go7007_init(struct saa7134_dev *dev)
419{
420 struct go7007 *go;
421 struct saa7134_go7007 *saa;
422 struct v4l2_subdev *sd;
423
424 pr_debug("saa7134-go7007: probing new SAA713X board\n");
425
426 go = go7007_alloc(&board_voyager, &dev->pci->dev);
427 if (go == NULL)
428 return -ENOMEM;
429
430 saa = kzalloc(sizeof(struct saa7134_go7007), GFP_KERNEL);
431 if (saa == NULL) {
432 kfree(go);
433 return -ENOMEM;
434 }
435
436 go->board_id = GO7007_BOARDID_PCI_VOYAGER;
437 snprintf(go->bus_info, sizeof(go->bus_info), "PCI:%s", pci_name(dev->pci));
438 strlcpy(go->name, saa7134_boards[dev->board].name, sizeof(go->name));
439 go->hpi_ops = &saa7134_go7007_hpi_ops;
440 go->hpi_context = saa;
441 saa->dev = dev;
442
443
444 sd = &saa->sd;
445 v4l2_subdev_init(sd, &saa7134_go7007_sd_ops);
446 v4l2_set_subdevdata(sd, saa);
447 strncpy(sd->name, "saa7134-go7007", sizeof(sd->name));
448
449
450 saa->top = (u8 *)get_zeroed_page(GFP_KERNEL);
451 if (!saa->top)
452 goto allocfail;
453 saa->bottom = (u8 *)get_zeroed_page(GFP_KERNEL);
454 if (!saa->bottom)
455 goto allocfail;
456
457
458 if (go7007_boot_encoder(go, go->board_info->flags &
459 GO7007_BOARD_USE_ONBOARD_I2C) < 0)
460 goto allocfail;
461
462
463
464 if (go7007_register_encoder(go, go->board_info->num_i2c_devs) < 0)
465 goto allocfail;
466
467
468 if (v4l2_device_register_subdev(&go->v4l2_dev, sd) < 0)
469 pr_info("saa7134-go7007: register subdev failed\n");
470
471 dev->empress_dev = &go->vdev;
472
473 go->status = STATUS_ONLINE;
474 return 0;
475
476allocfail:
477 if (saa->top)
478 free_page((unsigned long)saa->top);
479 if (saa->bottom)
480 free_page((unsigned long)saa->bottom);
481 kfree(saa);
482 kfree(go);
483 return -ENOMEM;
484}
485
486static int saa7134_go7007_fini(struct saa7134_dev *dev)
487{
488 struct go7007 *go;
489 struct saa7134_go7007 *saa;
490
491 if (NULL == dev->empress_dev)
492 return 0;
493
494 go = video_get_drvdata(dev->empress_dev);
495 if (go->audio_enabled)
496 go7007_snd_remove(go);
497
498 saa = go->hpi_context;
499 go->status = STATUS_SHUTDOWN;
500 free_page((unsigned long)saa->top);
501 free_page((unsigned long)saa->bottom);
502 v4l2_device_unregister_subdev(&saa->sd);
503 kfree(saa);
504 video_unregister_device(&go->vdev);
505
506 v4l2_device_put(&go->v4l2_dev);
507 dev->empress_dev = NULL;
508
509 return 0;
510}
511
512static struct saa7134_mpeg_ops saa7134_go7007_ops = {
513 .type = SAA7134_MPEG_GO7007,
514 .init = saa7134_go7007_init,
515 .fini = saa7134_go7007_fini,
516 .irq_ts_done = saa7134_go7007_irq_ts_done,
517};
518
519static int __init saa7134_go7007_mod_init(void)
520{
521 return saa7134_ts_register(&saa7134_go7007_ops);
522}
523
524static void __exit saa7134_go7007_mod_cleanup(void)
525{
526 saa7134_ts_unregister(&saa7134_go7007_ops);
527}
528
529module_init(saa7134_go7007_mod_init);
530module_exit(saa7134_go7007_mod_cleanup);
531
532MODULE_LICENSE("GPL v2");
533
