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 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 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 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 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 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 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 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 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 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 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 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 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 506 static int __init saa7134_go7007_mod_init(void) 507 { 508 return saa7134_ts_register(&saa7134_go7007_ops); 509 } 510 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