These changes are the raw update to linux-4.4.6-rt14. Kernel sources
[kvmfornfv.git] / kernel / drivers / media / pci / saa7134 / saa7134-go7007.c
1 /*
2  * Copyright (C) 2005-2006 Micronas USA Inc.
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License (Version 2) as
6  * published by the Free Software Foundation.
7  *
8  * This program is distributed in the hope that it will be useful,
9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
11  * GNU General Public License for more details.
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 /*#define GO7007_HPI_DEBUG*/
36
37 enum 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
47 enum gpio_command {
48         GPIO_COMMAND_RESET = 0x00, /* 000b */
49         GPIO_COMMAND_REQ1  = 0x04, /* 001b */
50         GPIO_COMMAND_WRITE = 0x20, /* 010b */
51         GPIO_COMMAND_REQ2  = 0x24, /* 011b */
52         GPIO_COMMAND_READ  = 0x80, /* 100b */
53         GPIO_COMMAND_VIDEO = 0x84, /* 101b */
54         GPIO_COMMAND_IDLE  = 0xA0, /* 110b */
55         GPIO_COMMAND_ADDR  = 0xA4, /* 111b */
56 };
57
58 struct 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
67 static inline struct saa7134_go7007 *to_state(struct v4l2_subdev *sd)
68 {
69         return container_of(sd, struct saa7134_go7007, sd);
70 }
71
72 static 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 /********************* Driver for GPIO HPI interface *********************/
93
94 static int gpio_write(struct saa7134_dev *dev, u8 addr, u16 data)
95 {
96         saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);
97
98         /* Write HPI address */
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         /* Write low byte */
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         /* Write high byte */
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
116 static int gpio_read(struct saa7134_dev *dev, u8 addr, u16 *data)
117 {
118         saa_writeb(SAA7134_GPIO_GPMODE0, 0xff);
119
120         /* Write HPI address */
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         /* Read low byte */
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         /* Read high byte */
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
144 static 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); /* Disable TS interface */
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         /*pr_debug("status is %s\n", saa_readb(SAA7134_GPIO_GPSTATUS2) & 0x40 ? "OK" : "not OK"); */
167
168         /* enter command mode...(?) */
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                 /*pr_info("gpio is %08x\n", saa_readl(SAA7134_GPIO_GPSTATUS0 >> 2)); */
177         } while (--count > 0);
178
179         /* Wait for an interrupt to indicate successful hardware reset */
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
188 static 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
216 static 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         /* XXX we need to wait if there is no interrupt available */
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
232 static 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
256 static 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         /* Set HPI interface for video */
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         /* Enable TS interface */
284         saa_writeb(SAA7134_TS_PARALLEL, 0xe6);
285
286         /* Reset TS interface */
287         saa_setb(SAA7134_TS_SERIAL1, 0x01);
288         saa_clearb(SAA7134_TS_SERIAL1, 0x01);
289
290         /* Set up transfer block size */
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         /* Enable video streaming mode */
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         /* Enable TS FIFO */
305         saa_setl(SAA7134_MAIN_CTRL, SAA7134_MAIN_CTRL_TE5);
306
307         /* Enable DMA IRQ */
308         saa_setl(SAA7134_IRQ1,
309                         SAA7134_IRQ1_INTE_RA2_1 | SAA7134_IRQ1_INTE_RA2_0);
310
311         return 0;
312 }
313
314 static 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         /* Shut down TS FIFO */
326         saa_clearl(SAA7134_MAIN_CTRL, SAA7134_MAIN_CTRL_TE5);
327
328         /* Disable DMA IRQ */
329         saa_clearl(SAA7134_IRQ1,
330                         SAA7134_IRQ1_INTE_RA2_1 | SAA7134_IRQ1_INTE_RA2_0);
331
332         /* Disable TS interface */
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
343 static 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
381 static 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 };
389 MODULE_FIRMWARE("go7007/go7007tv.bin");
390
391 /* --------------------------------------------------------------------------*/
392
393 static 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
405 static const struct v4l2_subdev_video_ops saa7134_go7007_video_ops = {
406         .s_std = saa7134_go7007_s_std,
407 };
408
409 static const struct v4l2_subdev_ops saa7134_go7007_sd_ops = {
410         .video = &saa7134_go7007_video_ops,
411 };
412
413 /* --------------------------------------------------------------------------*/
414
415
416 /********************* Add/remove functions *********************/
417
418 static 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         /* Init the subdevice interface */
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         /* Allocate a couple pages for receiving the compressed stream */
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         /* Boot the GO7007 */
458         if (go7007_boot_encoder(go, go->board_info->flags &
459                                         GO7007_BOARD_USE_ONBOARD_I2C) < 0)
460                 goto allocfail;
461
462         /* Do any final GO7007 initialization, then register the
463          * V4L2 and ALSA interfaces */
464         if (go7007_register_encoder(go, go->board_info->num_i2c_devs) < 0)
465                 goto allocfail;
466
467         /* Register the subdevice interface with the go7007 device */
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
476 allocfail:
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
486 static 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
512 static 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
519 static int __init saa7134_go7007_mod_init(void)
520 {
521         return saa7134_ts_register(&saa7134_go7007_ops);
522 }
523
524 static void __exit saa7134_go7007_mod_cleanup(void)
525 {
526         saa7134_ts_unregister(&saa7134_go7007_ops);
527 }
528
529 module_init(saa7134_go7007_mod_init);
530 module_exit(saa7134_go7007_mod_cleanup);
531
532 MODULE_LICENSE("GPL v2");