1// SPDX-License-Identifier: GPL-2.0-or-later 2/* 3 * driver for Earthsoft PT1/PT2 4 * 5 * Copyright (C) 2009 HIRANO Takahito <hiranotaka@zng.info> 6 * 7 * based on pt1dvr - http://pt1dvr.sourceforge.jp/ 8 * by Tomoaki Ishikawa <tomy@users.sourceforge.jp> 9 */ 10 11#include <linux/kernel.h> 12#include <linux/sched.h> 13#include <linux/sched/signal.h> 14#include <linux/hrtimer.h> 15#include <linux/delay.h> 16#include <linux/module.h> 17#include <linux/slab.h> 18#include <linux/vmalloc.h> 19#include <linux/pci.h> 20#include <linux/kthread.h> 21#include <linux/freezer.h> 22#include <linux/ratelimit.h> 23#include <linux/string.h> 24#include <linux/i2c.h> 25 26#include <media/dvbdev.h> 27#include <media/dvb_demux.h> 28#include <media/dmxdev.h> 29#include <media/dvb_net.h> 30#include <media/dvb_frontend.h> 31 32#include "tc90522.h" 33#include "qm1d1b0004.h" 34#include "dvb-pll.h" 35 36#define DRIVER_NAME "earth-pt1" 37 38#define PT1_PAGE_SHIFT 12 39#define PT1_PAGE_SIZE (1 << PT1_PAGE_SHIFT) 40#define PT1_NR_UPACKETS 1024 41#define PT1_NR_BUFS 511 42 43struct pt1_buffer_page { 44 __le32 upackets[PT1_NR_UPACKETS]; 45}; 46 47struct pt1_table_page { 48 __le32 next_pfn; 49 __le32 buf_pfns[PT1_NR_BUFS]; 50}; 51 52struct pt1_buffer { 53 struct pt1_buffer_page *page; 54 dma_addr_t addr; 55}; 56 57struct pt1_table { 58 struct pt1_table_page *page; 59 dma_addr_t addr; 60 struct pt1_buffer bufs[PT1_NR_BUFS]; 61}; 62 63enum pt1_fe_clk { 64 PT1_FE_CLK_20MHZ, /* PT1 */ 65 PT1_FE_CLK_25MHZ, /* PT2 */ 66}; 67 68#define PT1_NR_ADAPS 4 69 70struct pt1_adapter; 71 72struct pt1 { 73 struct pci_dev *pdev; 74 void __iomem *regs; 75 struct i2c_adapter i2c_adap; 76 int i2c_running; 77 struct pt1_adapter *adaps[PT1_NR_ADAPS]; 78 struct pt1_table *tables; 79 struct task_struct *kthread; 80 int table_index; 81 int buf_index; 82 83 struct mutex lock; 84 int power; 85 int reset; 86 87 enum pt1_fe_clk fe_clk; 88}; 89 90struct pt1_adapter { 91 struct pt1 *pt1; 92 int index; 93 94 u8 *buf; 95 int upacket_count; 96 int packet_count; 97 int st_count; 98 99 struct dvb_adapter adap; 100 struct dvb_demux demux; 101 int users; 102 struct dmxdev dmxdev; 103 struct dvb_frontend *fe; 104 struct i2c_client *demod_i2c_client; 105 struct i2c_client *tuner_i2c_client; 106 int (*orig_set_voltage)(struct dvb_frontend *fe, 107 enum fe_sec_voltage voltage); 108 int (*orig_sleep)(struct dvb_frontend *fe); 109 int (*orig_init)(struct dvb_frontend *fe); 110 111 enum fe_sec_voltage voltage; 112 int sleep; 113}; 114 115union pt1_tuner_config { 116 struct qm1d1b0004_config qm1d1b0004; 117 struct dvb_pll_config tda6651; 118}; 119 120struct pt1_config { 121 struct i2c_board_info demod_info; 122 struct tc90522_config demod_cfg; 123 124 struct i2c_board_info tuner_info; 125 union pt1_tuner_config tuner_cfg; 126}; 127 128static const struct pt1_config pt1_configs[PT1_NR_ADAPS] = { 129 { 130 .demod_info = { 131 I2C_BOARD_INFO(TC90522_I2C_DEV_SAT, 0x1b), 132 }, 133 .tuner_info = { 134 I2C_BOARD_INFO("qm1d1b0004", 0x60), 135 }, 136 }, 137 { 138 .demod_info = { 139 I2C_BOARD_INFO(TC90522_I2C_DEV_TER, 0x1a), 140 }, 141 .tuner_info = { 142 I2C_BOARD_INFO("tda665x_earthpt1", 0x61), 143 }, 144 }, 145 { 146 .demod_info = { 147 I2C_BOARD_INFO(TC90522_I2C_DEV_SAT, 0x19), 148 }, 149 .tuner_info = { 150 I2C_BOARD_INFO("qm1d1b0004", 0x60), 151 }, 152 }, 153 { 154 .demod_info = { 155 I2C_BOARD_INFO(TC90522_I2C_DEV_TER, 0x18), 156 }, 157 .tuner_info = { 158 I2C_BOARD_INFO("tda665x_earthpt1", 0x61), 159 }, 160 }, 161}; 162 163static const u8 va1j5jf8007s_20mhz_configs[][2] = { 164 {0x04, 0x02}, {0x0d, 0x55}, {0x11, 0x40}, {0x13, 0x80}, {0x17, 0x01}, 165 {0x1c, 0x0a}, {0x1d, 0xaa}, {0x1e, 0x20}, {0x1f, 0x88}, {0x51, 0xb0}, 166 {0x52, 0x89}, {0x53, 0xb3}, {0x5a, 0x2d}, {0x5b, 0xd3}, {0x85, 0x69}, 167 {0x87, 0x04}, {0x8e, 0x02}, {0xa3, 0xf7}, {0xa5, 0xc0}, 168}; 169 170static const u8 va1j5jf8007s_25mhz_configs[][2] = { 171 {0x04, 0x02}, {0x11, 0x40}, {0x13, 0x80}, {0x17, 0x01}, {0x1c, 0x0a}, 172 {0x1d, 0xaa}, {0x1e, 0x20}, {0x1f, 0x88}, {0x51, 0xb0}, {0x52, 0x89}, 173 {0x53, 0xb3}, {0x5a, 0x2d}, {0x5b, 0xd3}, {0x85, 0x69}, {0x87, 0x04}, 174 {0x8e, 0x26}, {0xa3, 0xf7}, {0xa5, 0xc0}, 175}; 176 177static const u8 va1j5jf8007t_20mhz_configs[][2] = { 178 {0x03, 0x90}, {0x14, 0x8f}, {0x1c, 0x2a}, {0x1d, 0xa8}, {0x1e, 0xa2}, 179 {0x22, 0x83}, {0x31, 0x0d}, {0x32, 0xe0}, {0x39, 0xd3}, {0x3a, 0x00}, 180 {0x3b, 0x11}, {0x3c, 0x3f}, 181 {0x5c, 0x40}, {0x5f, 0x80}, {0x75, 0x02}, {0x76, 0x4e}, {0x77, 0x03}, 182 {0xef, 0x01} 183}; 184 185static const u8 va1j5jf8007t_25mhz_configs[][2] = { 186 {0x03, 0x90}, {0x1c, 0x2a}, {0x1d, 0xa8}, {0x1e, 0xa2}, {0x22, 0x83}, 187 {0x3a, 0x04}, {0x3b, 0x11}, {0x3c, 0x3f}, {0x5c, 0x40}, {0x5f, 0x80}, 188 {0x75, 0x0a}, {0x76, 0x4c}, {0x77, 0x03}, {0xef, 0x01} 189}; 190 191static int config_demod(struct i2c_client *cl, enum pt1_fe_clk clk) 192{ 193 int ret; 194 bool is_sat; 195 const u8 (*cfg_data)[2]; 196 int i, len; 197 198 is_sat = !strncmp(cl->name, TC90522_I2C_DEV_SAT, 199 strlen(TC90522_I2C_DEV_SAT)); 200 if (is_sat) { 201 struct i2c_msg msg[2]; 202 u8 wbuf, rbuf; 203 204 wbuf = 0x07; 205 msg[0].addr = cl->addr; 206 msg[0].flags = 0; 207 msg[0].len = 1; 208 msg[0].buf = &wbuf; 209 210 msg[1].addr = cl->addr; 211 msg[1].flags = I2C_M_RD; 212 msg[1].len = 1; 213 msg[1].buf = &rbuf; 214 ret = i2c_transfer(cl->adapter, msg, 2); 215 if (ret < 0) 216 return ret; 217 if (rbuf != 0x41) 218 return -EIO; 219 } 220 221 /* frontend init */ 222 if (clk == PT1_FE_CLK_20MHZ) { 223 if (is_sat) { 224 cfg_data = va1j5jf8007s_20mhz_configs; 225 len = ARRAY_SIZE(va1j5jf8007s_20mhz_configs); 226 } else { 227 cfg_data = va1j5jf8007t_20mhz_configs; 228 len = ARRAY_SIZE(va1j5jf8007t_20mhz_configs); 229 } 230 } else { 231 if (is_sat) { 232 cfg_data = va1j5jf8007s_25mhz_configs; 233 len = ARRAY_SIZE(va1j5jf8007s_25mhz_configs); 234 } else { 235 cfg_data = va1j5jf8007t_25mhz_configs; 236 len = ARRAY_SIZE(va1j5jf8007t_25mhz_configs); 237 } 238 } 239 240 for (i = 0; i < len; i++) { 241 ret = i2c_master_send(cl, cfg_data[i], 2); 242 if (ret < 0) 243 return ret; 244 } 245 return 0; 246} 247 248/* 249 * Init registers for (each pair of) terrestrial/satellite block in demod. 250 * Note that resetting terr. block also resets its peer sat. block as well. 251 * This function must be called before configuring any demod block 252 * (before pt1_wakeup(), fe->ops.init()). 253 */ 254static int pt1_demod_block_init(struct pt1 *pt1) 255{ 256 struct i2c_client *cl; 257 u8 buf[2] = {0x01, 0x80}; 258 int ret; 259 int i; 260 261 /* reset all terr. & sat. pairs first */ 262 for (i = 0; i < PT1_NR_ADAPS; i++) { 263 cl = pt1->adaps[i]->demod_i2c_client; 264 if (strncmp(cl->name, TC90522_I2C_DEV_TER, 265 strlen(TC90522_I2C_DEV_TER))) 266 continue; 267 268 ret = i2c_master_send(cl, buf, 2); 269 if (ret < 0) 270 return ret; 271 usleep_range(30000, 50000); 272 } 273 274 for (i = 0; i < PT1_NR_ADAPS; i++) { 275 cl = pt1->adaps[i]->demod_i2c_client; 276 if (strncmp(cl->name, TC90522_I2C_DEV_SAT, 277 strlen(TC90522_I2C_DEV_SAT))) 278 continue; 279 280 ret = i2c_master_send(cl, buf, 2); 281 if (ret < 0) 282 return ret; 283 usleep_range(30000, 50000); 284 } 285 return 0; 286} 287 288static void pt1_write_reg(struct pt1 *pt1, int reg, u32 data) 289{ 290 writel(data, pt1->regs + reg * 4); 291} 292 293static u32 pt1_read_reg(struct pt1 *pt1, int reg) 294{ 295 return readl(pt1->regs + reg * 4); 296} 297 298static unsigned int pt1_nr_tables = 8; 299module_param_named(nr_tables, pt1_nr_tables, uint, 0); 300 301static void pt1_increment_table_count(struct pt1 *pt1) 302{ 303 pt1_write_reg(pt1, 0, 0x00000020); 304} 305 306static void pt1_init_table_count(struct pt1 *pt1) 307{ 308 pt1_write_reg(pt1, 0, 0x00000010); 309} 310 311static void pt1_register_tables(struct pt1 *pt1, u32 first_pfn) 312{ 313 pt1_write_reg(pt1, 5, first_pfn); 314 pt1_write_reg(pt1, 0, 0x0c000040); 315} 316 317static void pt1_unregister_tables(struct pt1 *pt1) 318{ 319 pt1_write_reg(pt1, 0, 0x08080000); 320} 321 322static int pt1_sync(struct pt1 *pt1) 323{ 324 int i; 325 for (i = 0; i < 57; i++) { 326 if (pt1_read_reg(pt1, 0) & 0x20000000) 327 return 0; 328 pt1_write_reg(pt1, 0, 0x00000008); 329 } 330 dev_err(&pt1->pdev->dev, "could not sync\n"); 331 return -EIO; 332} 333 334static u64 pt1_identify(struct pt1 *pt1) 335{ 336 int i; 337 u64 id = 0; 338 for (i = 0; i < 57; i++) { 339 id |= (u64)(pt1_read_reg(pt1, 0) >> 30 & 1) << i; 340 pt1_write_reg(pt1, 0, 0x00000008); 341 } 342 return id; 343} 344 345static int pt1_unlock(struct pt1 *pt1) 346{ 347 int i; 348 pt1_write_reg(pt1, 0, 0x00000008); 349 for (i = 0; i < 3; i++) { 350 if (pt1_read_reg(pt1, 0) & 0x80000000) 351 return 0; 352 usleep_range(1000, 2000); 353 } 354 dev_err(&pt1->pdev->dev, "could not unlock\n"); 355 return -EIO; 356} 357 358static int pt1_reset_pci(struct pt1 *pt1) 359{ 360 int i; 361 pt1_write_reg(pt1, 0, 0x01010000); 362 pt1_write_reg(pt1, 0, 0x01000000); 363 for (i = 0; i < 10; i++) { 364 if (pt1_read_reg(pt1, 0) & 0x00000001) 365 return 0; 366 usleep_range(1000, 2000); 367 } 368 dev_err(&pt1->pdev->dev, "could not reset PCI\n"); 369 return -EIO; 370} 371 372static int pt1_reset_ram(struct pt1 *pt1) 373{ 374 int i; 375 pt1_write_reg(pt1, 0, 0x02020000); 376 pt1_write_reg(pt1, 0, 0x02000000); 377 for (i = 0; i < 10; i++) { 378 if (pt1_read_reg(pt1, 0) & 0x00000002) 379 return 0; 380 usleep_range(1000, 2000); 381 } 382 dev_err(&pt1->pdev->dev, "could not reset RAM\n"); 383 return -EIO; 384} 385 386static int pt1_do_enable_ram(struct pt1 *pt1) 387{ 388 int i, j; 389 u32 status; 390 status = pt1_read_reg(pt1, 0) & 0x00000004; 391 pt1_write_reg(pt1, 0, 0x00000002); 392 for (i = 0; i < 10; i++) { 393 for (j = 0; j < 1024; j++) { 394 if ((pt1_read_reg(pt1, 0) & 0x00000004) != status) 395 return 0; 396 } 397 usleep_range(1000, 2000); 398 } 399 dev_err(&pt1->pdev->dev, "could not enable RAM\n"); 400 return -EIO; 401} 402 403static int pt1_enable_ram(struct pt1 *pt1) 404{ 405 int i, ret; 406 int phase; 407 usleep_range(1000, 2000); 408 phase = pt1->pdev->device == 0x211a ? 128 : 166; 409 for (i = 0; i < phase; i++) { 410 ret = pt1_do_enable_ram(pt1); 411 if (ret < 0) 412 return ret; 413 } 414 return 0; 415} 416 417static void pt1_disable_ram(struct pt1 *pt1) 418{ 419 pt1_write_reg(pt1, 0, 0x0b0b0000); 420} 421 422static void pt1_set_stream(struct pt1 *pt1, int index, int enabled) 423{ 424 pt1_write_reg(pt1, 2, 1 << (index + 8) | enabled << index); 425} 426 427static void pt1_init_streams(struct pt1 *pt1) 428{ 429 int i; 430 for (i = 0; i < PT1_NR_ADAPS; i++) 431 pt1_set_stream(pt1, i, 0); 432} 433 434static int pt1_filter(struct pt1 *pt1, struct pt1_buffer_page *page) 435{ 436 u32 upacket; 437 int i; 438 int index; 439 struct pt1_adapter *adap; 440 int offset; 441 u8 *buf; 442 int sc; 443 444 if (!page->upackets[PT1_NR_UPACKETS - 1]) 445 return 0; 446 447 for (i = 0; i < PT1_NR_UPACKETS; i++) { 448 upacket = le32_to_cpu(page->upackets[i]); 449 index = (upacket >> 29) - 1; 450 if (index < 0 || index >= PT1_NR_ADAPS) 451 continue; 452 453 adap = pt1->adaps[index]; 454 if (upacket >> 25 & 1) 455 adap->upacket_count = 0; 456 else if (!adap->upacket_count) 457 continue; 458 459 if (upacket >> 24 & 1) 460 printk_ratelimited(KERN_INFO "earth-pt1: device buffer overflowing. table[%d] buf[%d]\n", 461 pt1->table_index, pt1->buf_index); 462 sc = upacket >> 26 & 0x7; 463 if (adap->st_count != -1 && sc != ((adap->st_count + 1) & 0x7)) 464 printk_ratelimited(KERN_INFO "earth-pt1: data loss in streamID(adapter)[%d]\n", 465 index); 466 adap->st_count = sc; 467 468 buf = adap->buf; 469 offset = adap->packet_count * 188 + adap->upacket_count * 3; 470 buf[offset] = upacket >> 16; 471 buf[offset + 1] = upacket >> 8; 472 if (adap->upacket_count != 62) 473 buf[offset + 2] = upacket; 474 475 if (++adap->upacket_count >= 63) { 476 adap->upacket_count = 0; 477 if (++adap->packet_count >= 21) { 478 dvb_dmx_swfilter_packets(&adap->demux, buf, 21); 479 adap->packet_count = 0; 480 } 481 } 482 } 483 484 page->upackets[PT1_NR_UPACKETS - 1] = 0; 485 return 1; 486} 487 488static int pt1_thread(void *data) 489{ 490 struct pt1 *pt1; 491 struct pt1_buffer_page *page; 492 bool was_frozen; 493 494#define PT1_FETCH_DELAY 10 495#define PT1_FETCH_DELAY_DELTA 2 496 497 pt1 = data; 498 set_freezable(); 499 500 while (!kthread_freezable_should_stop(&was_frozen)) { 501 if (was_frozen) { 502 int i; 503 504 for (i = 0; i < PT1_NR_ADAPS; i++) 505 pt1_set_stream(pt1, i, !!pt1->adaps[i]->users); 506 } 507 508 page = pt1->tables[pt1->table_index].bufs[pt1->buf_index].page; 509 if (!pt1_filter(pt1, page)) { 510 ktime_t delay; 511 512 delay = ktime_set(0, PT1_FETCH_DELAY * NSEC_PER_MSEC); 513 set_current_state(TASK_INTERRUPTIBLE); 514 schedule_hrtimeout_range(&delay, 515 PT1_FETCH_DELAY_DELTA * NSEC_PER_MSEC, 516 HRTIMER_MODE_REL); 517 continue; 518 } 519 520 if (++pt1->buf_index >= PT1_NR_BUFS) { 521 pt1_increment_table_count(pt1); 522 pt1->buf_index = 0; 523 if (++pt1->table_index >= pt1_nr_tables) 524 pt1->table_index = 0; 525 } 526 } 527 528 return 0; 529} 530 531static void pt1_free_page(struct pt1 *pt1, void *page, dma_addr_t addr) 532{ 533 dma_free_coherent(&pt1->pdev->dev, PT1_PAGE_SIZE, page, addr); 534} 535 536static void *pt1_alloc_page(struct pt1 *pt1, dma_addr_t *addrp, u32 *pfnp) 537{ 538 void *page; 539 dma_addr_t addr; 540 541 page = dma_alloc_coherent(&pt1->pdev->dev, PT1_PAGE_SIZE, &addr, 542 GFP_KERNEL); 543 if (page == NULL) 544 return NULL; 545 546 BUG_ON(addr & (PT1_PAGE_SIZE - 1)); 547 BUG_ON(addr >> PT1_PAGE_SHIFT >> 31 >> 1); 548 549 *addrp = addr; 550 *pfnp = addr >> PT1_PAGE_SHIFT; 551 return page; 552} 553 554static void pt1_cleanup_buffer(struct pt1 *pt1, struct pt1_buffer *buf) 555{ 556 pt1_free_page(pt1, buf->page, buf->addr); 557} 558 559static int 560pt1_init_buffer(struct pt1 *pt1, struct pt1_buffer *buf, u32 *pfnp) 561{ 562 struct pt1_buffer_page *page; 563 dma_addr_t addr; 564 565 page = pt1_alloc_page(pt1, &addr, pfnp); 566 if (page == NULL) 567 return -ENOMEM; 568 569 page->upackets[PT1_NR_UPACKETS - 1] = 0; 570 571 buf->page = page; 572 buf->addr = addr; 573 return 0; 574} 575 576static void pt1_cleanup_table(struct pt1 *pt1, struct pt1_table *table) 577{ 578 int i; 579 580 for (i = 0; i < PT1_NR_BUFS; i++) 581 pt1_cleanup_buffer(pt1, &table->bufs[i]); 582 583 pt1_free_page(pt1, table->page, table->addr); 584} 585 586static int 587pt1_init_table(struct pt1 *pt1, struct pt1_table *table, u32 *pfnp) 588{ 589 struct pt1_table_page *page; 590 dma_addr_t addr; 591 int i, ret; 592 u32 buf_pfn; 593 594 page = pt1_alloc_page(pt1, &addr, pfnp); 595 if (page == NULL) 596 return -ENOMEM; 597 598 for (i = 0; i < PT1_NR_BUFS; i++) { 599 ret = pt1_init_buffer(pt1, &table->bufs[i], &buf_pfn); 600 if (ret < 0) 601 goto err; 602 603 page->buf_pfns[i] = cpu_to_le32(buf_pfn); 604 } 605 606 pt1_increment_table_count(pt1); 607 table->page = page; 608 table->addr = addr; 609 return 0; 610 611err: 612 while (i--) 613 pt1_cleanup_buffer(pt1, &table->bufs[i]); 614 615 pt1_free_page(pt1, page, addr); 616 return ret; 617} 618 619static void pt1_cleanup_tables(struct pt1 *pt1) 620{ 621 struct pt1_table *tables; 622 int i; 623 624 tables = pt1->tables; 625 pt1_unregister_tables(pt1); 626 627 for (i = 0; i < pt1_nr_tables; i++) 628 pt1_cleanup_table(pt1, &tables[i]); 629 630 vfree(tables); 631} 632 633static int pt1_init_tables(struct pt1 *pt1) 634{ 635 struct pt1_table *tables; 636 int i, ret; 637 u32 first_pfn, pfn; 638 639 if (!pt1_nr_tables) 640 return 0; 641 642 tables = vmalloc(array_size(pt1_nr_tables, sizeof(struct pt1_table))); 643 if (tables == NULL) 644 return -ENOMEM; 645 646 pt1_init_table_count(pt1); 647 648 i = 0; 649 ret = pt1_init_table(pt1, &tables[0], &first_pfn); 650 if (ret) 651 goto err; 652 i++; 653 654 while (i < pt1_nr_tables) { 655 ret = pt1_init_table(pt1, &tables[i], &pfn); 656 if (ret) 657 goto err; 658 tables[i - 1].page->next_pfn = cpu_to_le32(pfn); 659 i++; 660 } 661 662 tables[pt1_nr_tables - 1].page->next_pfn = cpu_to_le32(first_pfn); 663 664 pt1_register_tables(pt1, first_pfn); 665 pt1->tables = tables; 666 return 0; 667 668err: 669 while (i--) 670 pt1_cleanup_table(pt1, &tables[i]); 671 672 vfree(tables); 673 return ret; 674} 675 676static int pt1_start_polling(struct pt1 *pt1) 677{ 678 int ret = 0; 679 680 mutex_lock(&pt1->lock); 681 if (!pt1->kthread) { 682 pt1->kthread = kthread_run(pt1_thread, pt1, "earth-pt1"); 683 if (IS_ERR(pt1->kthread)) { 684 ret = PTR_ERR(pt1->kthread); 685 pt1->kthread = NULL; 686 } 687 } 688 mutex_unlock(&pt1->lock); 689 return ret; 690} 691 692static int pt1_start_feed(struct dvb_demux_feed *feed) 693{ 694 struct pt1_adapter *adap; 695 adap = container_of(feed->demux, struct pt1_adapter, demux); 696 if (!adap->users++) { 697 int ret; 698 699 ret = pt1_start_polling(adap->pt1); 700 if (ret) 701 return ret; 702 pt1_set_stream(adap->pt1, adap->index, 1); 703 } 704 return 0; 705} 706 707static void pt1_stop_polling(struct pt1 *pt1) 708{ 709 int i, count; 710 711 mutex_lock(&pt1->lock); 712 for (i = 0, count = 0; i < PT1_NR_ADAPS; i++) 713 count += pt1->adaps[i]->users; 714 715 if (count == 0 && pt1->kthread) { 716 kthread_stop(pt1->kthread); 717 pt1->kthread = NULL; 718 } 719 mutex_unlock(&pt1->lock); 720} 721 722static int pt1_stop_feed(struct dvb_demux_feed *feed) 723{ 724 struct pt1_adapter *adap; 725 adap = container_of(feed->demux, struct pt1_adapter, demux); 726 if (!--adap->users) { 727 pt1_set_stream(adap->pt1, adap->index, 0); 728 pt1_stop_polling(adap->pt1); 729 } 730 return 0; 731} 732 733static void 734pt1_update_power(struct pt1 *pt1) 735{ 736 int bits; 737 int i; 738 struct pt1_adapter *adap; 739 static const int sleep_bits[] = { 740 1 << 4, 741 1 << 6 | 1 << 7, 742 1 << 5, 743 1 << 6 | 1 << 8, 744 }; 745 746 bits = pt1->power | !pt1->reset << 3; 747 mutex_lock(&pt1->lock); 748 for (i = 0; i < PT1_NR_ADAPS; i++) { 749 adap = pt1->adaps[i]; 750 switch (adap->voltage) { 751 case SEC_VOLTAGE_13: /* actually 11V */ 752 bits |= 1 << 2; 753 break; 754 case SEC_VOLTAGE_18: /* actually 15V */ 755 bits |= 1 << 1 | 1 << 2; 756 break; 757 default: 758 break; 759 } 760 761 /* XXX: The bits should be changed depending on adap->sleep. */ 762 bits |= sleep_bits[i]; 763 } 764 pt1_write_reg(pt1, 1, bits); 765 mutex_unlock(&pt1->lock); 766} 767 768static int pt1_set_voltage(struct dvb_frontend *fe, enum fe_sec_voltage voltage) 769{ 770 struct pt1_adapter *adap; 771 772 adap = container_of(fe->dvb, struct pt1_adapter, adap); 773 adap->voltage = voltage; 774 pt1_update_power(adap->pt1); 775 776 if (adap->orig_set_voltage) 777 return adap->orig_set_voltage(fe, voltage); 778 else 779 return 0; 780} 781 782static int pt1_sleep(struct dvb_frontend *fe) 783{ 784 struct pt1_adapter *adap; 785 int ret; 786 787 adap = container_of(fe->dvb, struct pt1_adapter, adap); 788 789 ret = 0; 790 if (adap->orig_sleep) 791 ret = adap->orig_sleep(fe); 792 793 adap->sleep = 1; 794 pt1_update_power(adap->pt1); 795 return ret; 796} 797 798static int pt1_wakeup(struct dvb_frontend *fe) 799{ 800 struct pt1_adapter *adap; 801 int ret; 802 803 adap = container_of(fe->dvb, struct pt1_adapter, adap); 804 adap->sleep = 0; 805 pt1_update_power(adap->pt1); 806 usleep_range(1000, 2000); 807 808 ret = config_demod(adap->demod_i2c_client, adap->pt1->fe_clk); 809 if (ret == 0 && adap->orig_init) 810 ret = adap->orig_init(fe); 811 return ret; 812} 813 814static void pt1_free_adapter(struct pt1_adapter *adap) 815{ 816 adap->demux.dmx.close(&adap->demux.dmx); 817 dvb_dmxdev_release(&adap->dmxdev); 818 dvb_dmx_release(&adap->demux); 819 dvb_unregister_adapter(&adap->adap); 820 free_page((unsigned long)adap->buf); 821 kfree(adap); 822} 823 824DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr); 825 826static struct pt1_adapter * 827pt1_alloc_adapter(struct pt1 *pt1) 828{ 829 struct pt1_adapter *adap; 830 void *buf; 831 struct dvb_adapter *dvb_adap; 832 struct dvb_demux *demux; 833 struct dmxdev *dmxdev; 834 int ret; 835 836 adap = kzalloc(sizeof(struct pt1_adapter), GFP_KERNEL); 837 if (!adap) { 838 ret = -ENOMEM; 839 goto err; 840 } 841 842 adap->pt1 = pt1; 843 844 adap->voltage = SEC_VOLTAGE_OFF; 845 adap->sleep = 1; 846 847 buf = (u8 *)__get_free_page(GFP_KERNEL); 848 if (!buf) { 849 ret = -ENOMEM; 850 goto err_kfree; 851 } 852 853 adap->buf = buf; 854 adap->upacket_count = 0; 855 adap->packet_count = 0; 856 adap->st_count = -1; 857 858 dvb_adap = &adap->adap; 859 dvb_adap->priv = adap; 860 ret = dvb_register_adapter(dvb_adap, DRIVER_NAME, THIS_MODULE, 861 &pt1->pdev->dev, adapter_nr); 862 if (ret < 0) 863 goto err_free_page; 864 865 demux = &adap->demux; 866 demux->dmx.capabilities = DMX_TS_FILTERING | DMX_SECTION_FILTERING; 867 demux->priv = adap; 868 demux->feednum = 256; 869 demux->filternum = 256; 870 demux->start_feed = pt1_start_feed; 871 demux->stop_feed = pt1_stop_feed; 872 demux->write_to_decoder = NULL; 873 ret = dvb_dmx_init(demux); 874 if (ret < 0) 875 goto err_unregister_adapter; 876 877 dmxdev = &adap->dmxdev; 878 dmxdev->filternum = 256; 879 dmxdev->demux = &demux->dmx; 880 dmxdev->capabilities = 0; 881 ret = dvb_dmxdev_init(dmxdev, dvb_adap); 882 if (ret < 0) 883 goto err_dmx_release; 884 885 return adap; 886 887err_dmx_release: 888 dvb_dmx_release(demux); 889err_unregister_adapter: 890 dvb_unregister_adapter(dvb_adap); 891err_free_page: 892 free_page((unsigned long)buf); 893err_kfree: 894 kfree(adap); 895err: 896 return ERR_PTR(ret); 897} 898 899static void pt1_cleanup_adapters(struct pt1 *pt1) 900{ 901 int i; 902 for (i = 0; i < PT1_NR_ADAPS; i++) 903 pt1_free_adapter(pt1->adaps[i]); 904} 905 906static int pt1_init_adapters(struct pt1 *pt1) 907{ 908 int i; 909 struct pt1_adapter *adap; 910 int ret; 911 912 for (i = 0; i < PT1_NR_ADAPS; i++) { 913 adap = pt1_alloc_adapter(pt1); 914 if (IS_ERR(adap)) { 915 ret = PTR_ERR(adap); 916 goto err; 917 } 918 919 adap->index = i; 920 pt1->adaps[i] = adap; 921 } 922 return 0; 923 924err: 925 while (i--) 926 pt1_free_adapter(pt1->adaps[i]); 927 928 return ret; 929} 930 931static void pt1_cleanup_frontend(struct pt1_adapter *adap) 932{ 933 dvb_unregister_frontend(adap->fe); 934 dvb_module_release(adap->tuner_i2c_client); 935 dvb_module_release(adap->demod_i2c_client); 936} 937 938static int pt1_init_frontend(struct pt1_adapter *adap, struct dvb_frontend *fe) 939{ 940 int ret; 941 942 adap->orig_set_voltage = fe->ops.set_voltage; 943 adap->orig_sleep = fe->ops.sleep; 944 adap->orig_init = fe->ops.init; 945 fe->ops.set_voltage = pt1_set_voltage; 946 fe->ops.sleep = pt1_sleep; 947 fe->ops.init = pt1_wakeup; 948 949 ret = dvb_register_frontend(&adap->adap, fe); 950 if (ret < 0) 951 return ret; 952 953 adap->fe = fe; 954 return 0; 955} 956 957static void pt1_cleanup_frontends(struct pt1 *pt1) 958{ 959 int i; 960 for (i = 0; i < PT1_NR_ADAPS; i++) 961 pt1_cleanup_frontend(pt1->adaps[i]); 962} 963 964static int pt1_init_frontends(struct pt1 *pt1) 965{ 966 int i; 967 int ret; 968 969 for (i = 0; i < ARRAY_SIZE(pt1_configs); i++) { 970 const struct i2c_board_info *info; 971 struct tc90522_config dcfg; 972 struct i2c_client *cl; 973 974 info = &pt1_configs[i].demod_info; 975 dcfg = pt1_configs[i].demod_cfg; 976 dcfg.tuner_i2c = NULL; 977 978 ret = -ENODEV; 979 cl = dvb_module_probe("tc90522", info->type, &pt1->i2c_adap, 980 info->addr, &dcfg); 981 if (!cl) 982 goto fe_unregister; 983 pt1->adaps[i]->demod_i2c_client = cl; 984 985 if (!strncmp(cl->name, TC90522_I2C_DEV_SAT, 986 strlen(TC90522_I2C_DEV_SAT))) { 987 struct qm1d1b0004_config tcfg; 988 989 info = &pt1_configs[i].tuner_info; 990 tcfg = pt1_configs[i].tuner_cfg.qm1d1b0004; 991 tcfg.fe = dcfg.fe; 992 cl = dvb_module_probe("qm1d1b0004", 993 info->type, dcfg.tuner_i2c, 994 info->addr, &tcfg); 995 } else { 996 struct dvb_pll_config tcfg; 997 998 info = &pt1_configs[i].tuner_info; 999 tcfg = pt1_configs[i].tuner_cfg.tda6651; 1000 tcfg.fe = dcfg.fe; 1001 cl = dvb_module_probe("dvb_pll", 1002 info->type, dcfg.tuner_i2c, 1003 info->addr, &tcfg); 1004 } 1005 if (!cl) 1006 goto demod_release; 1007 pt1->adaps[i]->tuner_i2c_client = cl; 1008 1009 ret = pt1_init_frontend(pt1->adaps[i], dcfg.fe); 1010 if (ret < 0) 1011 goto tuner_release; 1012 } 1013 1014 ret = pt1_demod_block_init(pt1); 1015 if (ret < 0) 1016 goto fe_unregister; 1017 1018 return 0; 1019 1020tuner_release: 1021 dvb_module_release(pt1->adaps[i]->tuner_i2c_client); 1022demod_release: 1023 dvb_module_release(pt1->adaps[i]->demod_i2c_client); 1024fe_unregister: 1025 dev_warn(&pt1->pdev->dev, "failed to init FE(%d).\n", i); 1026 i--; 1027 for (; i >= 0; i--) { 1028 dvb_unregister_frontend(pt1->adaps[i]->fe); 1029 dvb_module_release(pt1->adaps[i]->tuner_i2c_client); 1030 dvb_module_release(pt1->adaps[i]->demod_i2c_client); 1031 } 1032 return ret; 1033} 1034 1035static void pt1_i2c_emit(struct pt1 *pt1, int addr, int busy, int read_enable, 1036 int clock, int data, int next_addr) 1037{ 1038 pt1_write_reg(pt1, 4, addr << 18 | busy << 13 | read_enable << 12 | 1039 !clock << 11 | !data << 10 | next_addr); 1040} 1041 1042static void pt1_i2c_write_bit(struct pt1 *pt1, int addr, int *addrp, int data) 1043{ 1044 pt1_i2c_emit(pt1, addr, 1, 0, 0, data, addr + 1); 1045 pt1_i2c_emit(pt1, addr + 1, 1, 0, 1, data, addr + 2); 1046 pt1_i2c_emit(pt1, addr + 2, 1, 0, 0, data, addr + 3); 1047 *addrp = addr + 3; 1048} 1049 1050static void pt1_i2c_read_bit(struct pt1 *pt1, int addr, int *addrp) 1051{ 1052 pt1_i2c_emit(pt1, addr, 1, 0, 0, 1, addr + 1); 1053 pt1_i2c_emit(pt1, addr + 1, 1, 0, 1, 1, addr + 2); 1054 pt1_i2c_emit(pt1, addr + 2, 1, 1, 1, 1, addr + 3); 1055 pt1_i2c_emit(pt1, addr + 3, 1, 0, 0, 1, addr + 4); 1056 *addrp = addr + 4; 1057} 1058 1059static void pt1_i2c_write_byte(struct pt1 *pt1, int addr, int *addrp, int data) 1060{ 1061 int i; 1062 for (i = 0; i < 8; i++) 1063 pt1_i2c_write_bit(pt1, addr, &addr, data >> (7 - i) & 1); 1064 pt1_i2c_write_bit(pt1, addr, &addr, 1); 1065 *addrp = addr; 1066} 1067 1068static void pt1_i2c_read_byte(struct pt1 *pt1, int addr, int *addrp, int last) 1069{ 1070 int i; 1071 for (i = 0; i < 8; i++) 1072 pt1_i2c_read_bit(pt1, addr, &addr); 1073 pt1_i2c_write_bit(pt1, addr, &addr, last); 1074 *addrp = addr; 1075} 1076 1077static void pt1_i2c_prepare(struct pt1 *pt1, int addr, int *addrp) 1078{ 1079 pt1_i2c_emit(pt1, addr, 1, 0, 1, 1, addr + 1); 1080 pt1_i2c_emit(pt1, addr + 1, 1, 0, 1, 0, addr + 2); 1081 pt1_i2c_emit(pt1, addr + 2, 1, 0, 0, 0, addr + 3); 1082 *addrp = addr + 3; 1083} 1084 1085static void 1086pt1_i2c_write_msg(struct pt1 *pt1, int addr, int *addrp, struct i2c_msg *msg) 1087{ 1088 int i; 1089 pt1_i2c_prepare(pt1, addr, &addr); 1090 pt1_i2c_write_byte(pt1, addr, &addr, msg->addr << 1); 1091 for (i = 0; i < msg->len; i++) 1092 pt1_i2c_write_byte(pt1, addr, &addr, msg->buf[i]); 1093 *addrp = addr; 1094} 1095 1096static void 1097pt1_i2c_read_msg(struct pt1 *pt1, int addr, int *addrp, struct i2c_msg *msg) 1098{ 1099 int i; 1100 pt1_i2c_prepare(pt1, addr, &addr); 1101 pt1_i2c_write_byte(pt1, addr, &addr, msg->addr << 1 | 1); 1102 for (i = 0; i < msg->len; i++) 1103 pt1_i2c_read_byte(pt1, addr, &addr, i == msg->len - 1); 1104 *addrp = addr; 1105} 1106 1107static int pt1_i2c_end(struct pt1 *pt1, int addr) 1108{ 1109 pt1_i2c_emit(pt1, addr, 1, 0, 0, 0, addr + 1); 1110 pt1_i2c_emit(pt1, addr + 1, 1, 0, 1, 0, addr + 2); 1111 pt1_i2c_emit(pt1, addr + 2, 1, 0, 1, 1, 0); 1112 1113 pt1_write_reg(pt1, 0, 0x00000004); 1114 do { 1115 if (signal_pending(current)) 1116 return -EINTR; 1117 usleep_range(1000, 2000); 1118 } while (pt1_read_reg(pt1, 0) & 0x00000080); 1119 return 0; 1120} 1121 1122static void pt1_i2c_begin(struct pt1 *pt1, int *addrp) 1123{ 1124 int addr = 0; 1125 1126 pt1_i2c_emit(pt1, addr, 0, 0, 1, 1, addr /* itself */); 1127 addr = addr + 1; 1128 1129 if (!pt1->i2c_running) { 1130 pt1_i2c_emit(pt1, addr, 1, 0, 1, 1, addr + 1); 1131 pt1_i2c_emit(pt1, addr + 1, 1, 0, 1, 0, addr + 2); 1132 addr = addr + 2; 1133 pt1->i2c_running = 1; 1134 } 1135 *addrp = addr; 1136} 1137 1138static int pt1_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num) 1139{ 1140 struct pt1 *pt1; 1141 int i; 1142 struct i2c_msg *msg, *next_msg; 1143 int addr, ret; 1144 u16 len; 1145 u32 word; 1146 1147 pt1 = i2c_get_adapdata(adap); 1148 1149 for (i = 0; i < num; i++) { 1150 msg = &msgs[i]; 1151 if (msg->flags & I2C_M_RD) 1152 return -ENOTSUPP; 1153 1154 if (i + 1 < num) 1155 next_msg = &msgs[i + 1]; 1156 else 1157 next_msg = NULL; 1158 1159 if (next_msg && next_msg->flags & I2C_M_RD) { 1160 i++; 1161 1162 len = next_msg->len; 1163 if (len > 4) 1164 return -ENOTSUPP; 1165 1166 pt1_i2c_begin(pt1, &addr); 1167 pt1_i2c_write_msg(pt1, addr, &addr, msg); 1168 pt1_i2c_read_msg(pt1, addr, &addr, next_msg); 1169 ret = pt1_i2c_end(pt1, addr); 1170 if (ret < 0) 1171 return ret; 1172 1173 word = pt1_read_reg(pt1, 2); 1174 while (len--) { 1175 next_msg->buf[len] = word; 1176 word >>= 8; 1177 } 1178 } else { 1179 pt1_i2c_begin(pt1, &addr); 1180 pt1_i2c_write_msg(pt1, addr, &addr, msg); 1181 ret = pt1_i2c_end(pt1, addr); 1182 if (ret < 0) 1183 return ret; 1184 } 1185 } 1186 1187 return num; 1188} 1189 1190static u32 pt1_i2c_func(struct i2c_adapter *adap) 1191{ 1192 return I2C_FUNC_I2C; 1193} 1194 1195static const struct i2c_algorithm pt1_i2c_algo = { 1196 .master_xfer = pt1_i2c_xfer, 1197 .functionality = pt1_i2c_func, 1198}; 1199 1200static void pt1_i2c_wait(struct pt1 *pt1) 1201{ 1202 int i; 1203 for (i = 0; i < 128; i++) 1204 pt1_i2c_emit(pt1, 0, 0, 0, 1, 1, 0); 1205} 1206 1207static void pt1_i2c_init(struct pt1 *pt1) 1208{ 1209 int i; 1210 for (i = 0; i < 1024; i++) 1211 pt1_i2c_emit(pt1, i, 0, 0, 1, 1, 0); 1212} 1213 1214#ifdef CONFIG_PM_SLEEP 1215 1216static int pt1_suspend(struct device *dev) 1217{ 1218 struct pt1 *pt1 = dev_get_drvdata(dev); 1219 1220 pt1_init_streams(pt1); 1221 pt1_disable_ram(pt1); 1222 pt1->power = 0; 1223 pt1->reset = 1; 1224 pt1_update_power(pt1); 1225 return 0; 1226} 1227 1228static int pt1_resume(struct device *dev) 1229{ 1230 struct pt1 *pt1 = dev_get_drvdata(dev); 1231 int ret; 1232 int i; 1233 1234 pt1->power = 0; 1235 pt1->reset = 1; 1236 pt1_update_power(pt1); 1237 1238 pt1_i2c_init(pt1); 1239 pt1_i2c_wait(pt1); 1240 1241 ret = pt1_sync(pt1); 1242 if (ret < 0) 1243 goto resume_err; 1244 1245 pt1_identify(pt1); 1246 1247 ret = pt1_unlock(pt1); 1248 if (ret < 0) 1249 goto resume_err; 1250 1251 ret = pt1_reset_pci(pt1); 1252 if (ret < 0) 1253 goto resume_err; 1254 1255 ret = pt1_reset_ram(pt1); 1256 if (ret < 0) 1257 goto resume_err; 1258 1259 ret = pt1_enable_ram(pt1); 1260 if (ret < 0) 1261 goto resume_err; 1262 1263 pt1_init_streams(pt1); 1264 1265 pt1->power = 1; 1266 pt1_update_power(pt1); 1267 msleep(20); 1268 1269 pt1->reset = 0; 1270 pt1_update_power(pt1); 1271 usleep_range(1000, 2000); 1272 1273 ret = pt1_demod_block_init(pt1); 1274 if (ret < 0) 1275 goto resume_err; 1276 1277 for (i = 0; i < PT1_NR_ADAPS; i++) 1278 dvb_frontend_reinitialise(pt1->adaps[i]->fe); 1279 1280 pt1_init_table_count(pt1); 1281 for (i = 0; i < pt1_nr_tables; i++) { 1282 int j; 1283 1284 for (j = 0; j < PT1_NR_BUFS; j++) 1285 pt1->tables[i].bufs[j].page->upackets[PT1_NR_UPACKETS-1] 1286 = 0; 1287 pt1_increment_table_count(pt1); 1288 } 1289 pt1_register_tables(pt1, pt1->tables[0].addr >> PT1_PAGE_SHIFT); 1290 1291 pt1->table_index = 0; 1292 pt1->buf_index = 0; 1293 for (i = 0; i < PT1_NR_ADAPS; i++) { 1294 pt1->adaps[i]->upacket_count = 0; 1295 pt1->adaps[i]->packet_count = 0; 1296 pt1->adaps[i]->st_count = -1; 1297 } 1298 1299 return 0; 1300 1301resume_err: 1302 dev_info(&pt1->pdev->dev, "failed to resume PT1/PT2."); 1303 return 0; /* resume anyway */ 1304} 1305 1306#endif /* CONFIG_PM_SLEEP */ 1307 1308static void pt1_remove(struct pci_dev *pdev) 1309{ 1310 struct pt1 *pt1; 1311 void __iomem *regs; 1312 1313 pt1 = pci_get_drvdata(pdev); 1314 regs = pt1->regs; 1315 1316 if (pt1->kthread) 1317 kthread_stop(pt1->kthread); 1318 pt1_cleanup_tables(pt1); 1319 pt1_cleanup_frontends(pt1); 1320 pt1_disable_ram(pt1); 1321 pt1->power = 0; 1322 pt1->reset = 1; 1323 pt1_update_power(pt1); 1324 pt1_cleanup_adapters(pt1); 1325 i2c_del_adapter(&pt1->i2c_adap); 1326 kfree(pt1); 1327 pci_iounmap(pdev, regs); 1328 pci_release_regions(pdev); 1329 pci_disable_device(pdev); 1330} 1331 1332static int pt1_probe(struct pci_dev *pdev, const struct pci_device_id *ent) 1333{ 1334 int ret; 1335 void __iomem *regs; 1336 struct pt1 *pt1; 1337 struct i2c_adapter *i2c_adap; 1338 1339 ret = pci_enable_device(pdev); 1340 if (ret < 0) 1341 goto err; 1342 1343 ret = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32)); 1344 if (ret < 0) 1345 goto err_pci_disable_device; 1346 1347 pci_set_master(pdev); 1348 1349 ret = pci_request_regions(pdev, DRIVER_NAME); 1350 if (ret < 0) 1351 goto err_pci_disable_device; 1352 1353 regs = pci_iomap(pdev, 0, 0); 1354 if (!regs) { 1355 ret = -EIO; 1356 goto err_pci_release_regions; 1357 } 1358 1359 pt1 = kzalloc(sizeof(struct pt1), GFP_KERNEL); 1360 if (!pt1) { 1361 ret = -ENOMEM; 1362 goto err_pci_iounmap; 1363 } 1364 1365 mutex_init(&pt1->lock); 1366 pt1->pdev = pdev; 1367 pt1->regs = regs; 1368 pt1->fe_clk = (pdev->device == 0x211a) ? 1369 PT1_FE_CLK_20MHZ : PT1_FE_CLK_25MHZ; 1370 pci_set_drvdata(pdev, pt1); 1371 1372 ret = pt1_init_adapters(pt1); 1373 if (ret < 0) 1374 goto err_kfree; 1375 1376 mutex_init(&pt1->lock); 1377 1378 pt1->power = 0; 1379 pt1->reset = 1; 1380 pt1_update_power(pt1); 1381 1382 i2c_adap = &pt1->i2c_adap; 1383 i2c_adap->algo = &pt1_i2c_algo; 1384 i2c_adap->algo_data = NULL; 1385 i2c_adap->dev.parent = &pdev->dev; 1386 strscpy(i2c_adap->name, DRIVER_NAME, sizeof(i2c_adap->name)); 1387 i2c_set_adapdata(i2c_adap, pt1); 1388 ret = i2c_add_adapter(i2c_adap); 1389 if (ret < 0) 1390 goto err_pt1_cleanup_adapters; 1391 1392 pt1_i2c_init(pt1); 1393 pt1_i2c_wait(pt1); 1394 1395 ret = pt1_sync(pt1); 1396 if (ret < 0) 1397 goto err_i2c_del_adapter; 1398 1399 pt1_identify(pt1); 1400 1401 ret = pt1_unlock(pt1); 1402 if (ret < 0) 1403 goto err_i2c_del_adapter; 1404 1405 ret = pt1_reset_pci(pt1); 1406 if (ret < 0) 1407 goto err_i2c_del_adapter; 1408 1409 ret = pt1_reset_ram(pt1); 1410 if (ret < 0) 1411 goto err_i2c_del_adapter; 1412 1413 ret = pt1_enable_ram(pt1); 1414 if (ret < 0) 1415 goto err_i2c_del_adapter; 1416 1417 pt1_init_streams(pt1); 1418 1419 pt1->power = 1; 1420 pt1_update_power(pt1); 1421 msleep(20); 1422 1423 pt1->reset = 0; 1424 pt1_update_power(pt1); 1425 usleep_range(1000, 2000); 1426 1427 ret = pt1_init_frontends(pt1); 1428 if (ret < 0) 1429 goto err_pt1_disable_ram; 1430 1431 ret = pt1_init_tables(pt1); 1432 if (ret < 0) 1433 goto err_pt1_cleanup_frontends; 1434 1435 return 0; 1436 1437err_pt1_cleanup_frontends: 1438 pt1_cleanup_frontends(pt1); 1439err_pt1_disable_ram: 1440 pt1_disable_ram(pt1); 1441 pt1->power = 0; 1442 pt1->reset = 1; 1443 pt1_update_power(pt1); 1444err_i2c_del_adapter: 1445 i2c_del_adapter(i2c_adap); 1446err_pt1_cleanup_adapters: 1447 pt1_cleanup_adapters(pt1); 1448err_kfree: 1449 kfree(pt1); 1450err_pci_iounmap: 1451 pci_iounmap(pdev, regs); 1452err_pci_release_regions: 1453 pci_release_regions(pdev); 1454err_pci_disable_device: 1455 pci_disable_device(pdev); 1456err: 1457 return ret; 1458 1459} 1460 1461static const struct pci_device_id pt1_id_table[] = { 1462 { PCI_DEVICE(0x10ee, 0x211a) }, 1463 { PCI_DEVICE(0x10ee, 0x222a) }, 1464 { }, 1465}; 1466MODULE_DEVICE_TABLE(pci, pt1_id_table); 1467 1468static SIMPLE_DEV_PM_OPS(pt1_pm_ops, pt1_suspend, pt1_resume); 1469 1470static struct pci_driver pt1_driver = { 1471 .name = DRIVER_NAME, 1472 .probe = pt1_probe, 1473 .remove = pt1_remove, 1474 .id_table = pt1_id_table, 1475 .driver.pm = &pt1_pm_ops, 1476}; 1477 1478module_pci_driver(pt1_driver); 1479 1480MODULE_AUTHOR("Takahito HIRANO <hiranotaka@zng.info>"); 1481MODULE_DESCRIPTION("Earthsoft PT1/PT2 Driver"); 1482MODULE_LICENSE("GPL"); 1483