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