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 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 }; 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 strscpy(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"); 533