803 lines · c
1// SPDX-License-Identifier: GPL-2.02/*3 * Earthsoft PT3 driver4 *5 * Copyright (C) 2014 Akihiro Tsukada <tskd08@gmail.com>6 */7 8#include <linux/freezer.h>9#include <linux/kernel.h>10#include <linux/kthread.h>11#include <linux/mutex.h>12#include <linux/module.h>13#include <linux/pci.h>14#include <linux/string.h>15#include <linux/sched/signal.h>16 17#include <media/dmxdev.h>18#include <media/dvbdev.h>19#include <media/dvb_demux.h>20#include <media/dvb_frontend.h>21 22#include "pt3.h"23 24DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);25 26static bool one_adapter;27module_param(one_adapter, bool, 0444);28MODULE_PARM_DESC(one_adapter, "Place FE's together under one adapter.");29 30static int num_bufs = 4;31module_param(num_bufs, int, 0444);32MODULE_PARM_DESC(num_bufs, "Number of DMA buffer (188KiB) per FE.");33 34 35static const struct i2c_algorithm pt3_i2c_algo = {36 .master_xfer = &pt3_i2c_master_xfer,37 .functionality = &pt3_i2c_functionality,38};39 40static const struct pt3_adap_config adap_conf[PT3_NUM_FE] = {41 {42 .demod_info = {43 I2C_BOARD_INFO(TC90522_I2C_DEV_SAT, 0x11),44 },45 .tuner_info = {46 I2C_BOARD_INFO("qm1d1c0042", 0x63),47 },48 .tuner_cfg.qm1d1c0042 = {49 .lpf = 1,50 },51 .init_freq = 1049480 - 300,52 },53 {54 .demod_info = {55 I2C_BOARD_INFO(TC90522_I2C_DEV_TER, 0x10),56 },57 .tuner_info = {58 I2C_BOARD_INFO("mxl301rf", 0x62),59 },60 .init_freq = 515142857,61 },62 {63 .demod_info = {64 I2C_BOARD_INFO(TC90522_I2C_DEV_SAT, 0x13),65 },66 .tuner_info = {67 I2C_BOARD_INFO("qm1d1c0042", 0x60),68 },69 .tuner_cfg.qm1d1c0042 = {70 .lpf = 1,71 },72 .init_freq = 1049480 + 300,73 },74 {75 .demod_info = {76 I2C_BOARD_INFO(TC90522_I2C_DEV_TER, 0x12),77 },78 .tuner_info = {79 I2C_BOARD_INFO("mxl301rf", 0x61),80 },81 .init_freq = 521142857,82 },83};84 85 86struct reg_val {87 u8 reg;88 u8 val;89};90 91static int92pt3_demod_write(struct pt3_adapter *adap, const struct reg_val *data, int num)93{94 struct i2c_msg msg;95 int i, ret;96 97 ret = 0;98 msg.addr = adap->i2c_demod->addr;99 msg.flags = 0;100 msg.len = 2;101 for (i = 0; i < num; i++) {102 msg.buf = (u8 *)&data[i];103 ret = i2c_transfer(adap->i2c_demod->adapter, &msg, 1);104 if (ret == 0)105 ret = -EREMOTE;106 if (ret < 0)107 return ret;108 }109 return 0;110}111 112static inline void pt3_lnb_ctrl(struct pt3_board *pt3, bool on)113{114 iowrite32((on ? 0x0f : 0x0c), pt3->regs[0] + REG_SYSTEM_W);115}116 117static inline struct pt3_adapter *pt3_find_adapter(struct dvb_frontend *fe)118{119 struct pt3_board *pt3;120 int i;121 122 if (one_adapter) {123 pt3 = fe->dvb->priv;124 for (i = 0; i < PT3_NUM_FE; i++)125 if (pt3->adaps[i]->fe == fe)126 return pt3->adaps[i];127 }128 return container_of(fe->dvb, struct pt3_adapter, dvb_adap);129}130 131/*132 * all 4 tuners in PT3 are packaged in a can module (Sharp VA4M6JC2103).133 * it seems that they share the power lines and Amp power line and134 * adaps[3] controls those powers.135 */136static int137pt3_set_tuner_power(struct pt3_board *pt3, bool tuner_on, bool amp_on)138{139 struct reg_val rv = { 0x1e, 0x99 };140 141 if (tuner_on)142 rv.val |= 0x40;143 if (amp_on)144 rv.val |= 0x04;145 return pt3_demod_write(pt3->adaps[PT3_NUM_FE - 1], &rv, 1);146}147 148static int pt3_set_lna(struct dvb_frontend *fe)149{150 struct pt3_adapter *adap;151 struct pt3_board *pt3;152 u32 val;153 int ret;154 155 /* LNA is shared btw. 2 TERR-tuners */156 157 adap = pt3_find_adapter(fe);158 val = fe->dtv_property_cache.lna;159 if (val == LNA_AUTO || val == adap->cur_lna)160 return 0;161 162 pt3 = adap->dvb_adap.priv;163 if (mutex_lock_interruptible(&pt3->lock))164 return -ERESTARTSYS;165 if (val)166 pt3->lna_on_cnt++;167 else168 pt3->lna_on_cnt--;169 170 if (val && pt3->lna_on_cnt <= 1) {171 pt3->lna_on_cnt = 1;172 ret = pt3_set_tuner_power(pt3, true, true);173 } else if (!val && pt3->lna_on_cnt <= 0) {174 pt3->lna_on_cnt = 0;175 ret = pt3_set_tuner_power(pt3, true, false);176 } else177 ret = 0;178 mutex_unlock(&pt3->lock);179 adap->cur_lna = (val != 0);180 return ret;181}182 183static int pt3_set_voltage(struct dvb_frontend *fe, enum fe_sec_voltage volt)184{185 struct pt3_adapter *adap;186 struct pt3_board *pt3;187 bool on;188 189 /* LNB power is shared btw. 2 SAT-tuners */190 191 adap = pt3_find_adapter(fe);192 on = (volt != SEC_VOLTAGE_OFF);193 if (on == adap->cur_lnb)194 return 0;195 adap->cur_lnb = on;196 pt3 = adap->dvb_adap.priv;197 if (mutex_lock_interruptible(&pt3->lock))198 return -ERESTARTSYS;199 if (on)200 pt3->lnb_on_cnt++;201 else202 pt3->lnb_on_cnt--;203 204 if (on && pt3->lnb_on_cnt <= 1) {205 pt3->lnb_on_cnt = 1;206 pt3_lnb_ctrl(pt3, true);207 } else if (!on && pt3->lnb_on_cnt <= 0) {208 pt3->lnb_on_cnt = 0;209 pt3_lnb_ctrl(pt3, false);210 }211 mutex_unlock(&pt3->lock);212 return 0;213}214 215/* register values used in pt3_fe_init() */216 217static const struct reg_val init0_sat[] = {218 { 0x03, 0x01 },219 { 0x1e, 0x10 },220};221static const struct reg_val init0_ter[] = {222 { 0x01, 0x40 },223 { 0x1c, 0x10 },224};225static const struct reg_val cfg_sat[] = {226 { 0x1c, 0x15 },227 { 0x1f, 0x04 },228};229static const struct reg_val cfg_ter[] = {230 { 0x1d, 0x01 },231};232 233/*234 * pt3_fe_init: initialize demod sub modules and ISDB-T tuners all at once.235 *236 * As for demod IC (TC90522) and ISDB-T tuners (MxL301RF),237 * the i2c sequences for init'ing them are not public and hidden in a ROM,238 * and include the board specific configurations as well.239 * They are stored in a lump and cannot be taken out / accessed separately,240 * thus cannot be moved to the FE/tuner driver.241 */242static int pt3_fe_init(struct pt3_board *pt3)243{244 int i, ret;245 struct dvb_frontend *fe;246 247 pt3_i2c_reset(pt3);248 ret = pt3_init_all_demods(pt3);249 if (ret < 0) {250 dev_warn(&pt3->pdev->dev, "Failed to init demod chips\n");251 return ret;252 }253 254 /* additional config? */255 for (i = 0; i < PT3_NUM_FE; i++) {256 fe = pt3->adaps[i]->fe;257 258 if (fe->ops.delsys[0] == SYS_ISDBS)259 ret = pt3_demod_write(pt3->adaps[i],260 init0_sat, ARRAY_SIZE(init0_sat));261 else262 ret = pt3_demod_write(pt3->adaps[i],263 init0_ter, ARRAY_SIZE(init0_ter));264 if (ret < 0) {265 dev_warn(&pt3->pdev->dev,266 "demod[%d] failed in init sequence0\n", i);267 return ret;268 }269 ret = fe->ops.init(fe);270 if (ret < 0)271 return ret;272 }273 274 usleep_range(2000, 4000);275 ret = pt3_set_tuner_power(pt3, true, false);276 if (ret < 0) {277 dev_warn(&pt3->pdev->dev, "Failed to control tuner module\n");278 return ret;279 }280 281 /* output pin configuration */282 for (i = 0; i < PT3_NUM_FE; i++) {283 fe = pt3->adaps[i]->fe;284 if (fe->ops.delsys[0] == SYS_ISDBS)285 ret = pt3_demod_write(pt3->adaps[i],286 cfg_sat, ARRAY_SIZE(cfg_sat));287 else288 ret = pt3_demod_write(pt3->adaps[i],289 cfg_ter, ARRAY_SIZE(cfg_ter));290 if (ret < 0) {291 dev_warn(&pt3->pdev->dev,292 "demod[%d] failed in init sequence1\n", i);293 return ret;294 }295 }296 usleep_range(4000, 6000);297 298 for (i = 0; i < PT3_NUM_FE; i++) {299 fe = pt3->adaps[i]->fe;300 if (fe->ops.delsys[0] != SYS_ISDBS)301 continue;302 /* init and wake-up ISDB-S tuners */303 ret = fe->ops.tuner_ops.init(fe);304 if (ret < 0) {305 dev_warn(&pt3->pdev->dev,306 "Failed to init SAT-tuner[%d]\n", i);307 return ret;308 }309 }310 ret = pt3_init_all_mxl301rf(pt3);311 if (ret < 0) {312 dev_warn(&pt3->pdev->dev, "Failed to init TERR-tuners\n");313 return ret;314 }315 316 ret = pt3_set_tuner_power(pt3, true, true);317 if (ret < 0) {318 dev_warn(&pt3->pdev->dev, "Failed to control tuner module\n");319 return ret;320 }321 322 /* Wake up all tuners and make an initial tuning,323 * in order to avoid interference among the tuners in the module,324 * according to the doc from the manufacturer.325 */326 for (i = 0; i < PT3_NUM_FE; i++) {327 fe = pt3->adaps[i]->fe;328 ret = 0;329 if (fe->ops.delsys[0] == SYS_ISDBT)330 ret = fe->ops.tuner_ops.init(fe);331 /* set only when called from pt3_probe(), not resume() */332 if (ret == 0 && fe->dtv_property_cache.frequency == 0) {333 fe->dtv_property_cache.frequency =334 adap_conf[i].init_freq;335 ret = fe->ops.tuner_ops.set_params(fe);336 }337 if (ret < 0) {338 dev_warn(&pt3->pdev->dev,339 "Failed in initial tuning of tuner[%d]\n", i);340 return ret;341 }342 }343 344 /* and sleep again, waiting to be opened by users. */345 for (i = 0; i < PT3_NUM_FE; i++) {346 fe = pt3->adaps[i]->fe;347 if (fe->ops.tuner_ops.sleep)348 ret = fe->ops.tuner_ops.sleep(fe);349 if (ret < 0)350 break;351 if (fe->ops.sleep)352 ret = fe->ops.sleep(fe);353 if (ret < 0)354 break;355 if (fe->ops.delsys[0] == SYS_ISDBS)356 fe->ops.set_voltage = &pt3_set_voltage;357 else358 fe->ops.set_lna = &pt3_set_lna;359 }360 if (i < PT3_NUM_FE) {361 dev_warn(&pt3->pdev->dev, "FE[%d] failed to standby\n", i);362 return ret;363 }364 return 0;365}366 367 368static int pt3_attach_fe(struct pt3_board *pt3, int i)369{370 const struct i2c_board_info *info;371 struct tc90522_config cfg;372 struct i2c_client *cl;373 struct dvb_adapter *dvb_adap;374 int ret;375 376 info = &adap_conf[i].demod_info;377 cfg = adap_conf[i].demod_cfg;378 cfg.tuner_i2c = NULL;379 380 ret = -ENODEV;381 cl = dvb_module_probe("tc90522", info->type, &pt3->i2c_adap,382 info->addr, &cfg);383 if (!cl)384 return -ENODEV;385 pt3->adaps[i]->i2c_demod = cl;386 387 if (!strncmp(cl->name, TC90522_I2C_DEV_SAT,388 strlen(TC90522_I2C_DEV_SAT))) {389 struct qm1d1c0042_config tcfg;390 391 tcfg = adap_conf[i].tuner_cfg.qm1d1c0042;392 tcfg.fe = cfg.fe;393 info = &adap_conf[i].tuner_info;394 cl = dvb_module_probe("qm1d1c0042", info->type, cfg.tuner_i2c,395 info->addr, &tcfg);396 } else {397 struct mxl301rf_config tcfg;398 399 tcfg = adap_conf[i].tuner_cfg.mxl301rf;400 tcfg.fe = cfg.fe;401 info = &adap_conf[i].tuner_info;402 cl = dvb_module_probe("mxl301rf", info->type, cfg.tuner_i2c,403 info->addr, &tcfg);404 }405 if (!cl)406 goto err_demod_module_release;407 pt3->adaps[i]->i2c_tuner = cl;408 409 dvb_adap = &pt3->adaps[one_adapter ? 0 : i]->dvb_adap;410 ret = dvb_register_frontend(dvb_adap, cfg.fe);411 if (ret < 0)412 goto err_tuner_module_release;413 pt3->adaps[i]->fe = cfg.fe;414 return 0;415 416err_tuner_module_release:417 dvb_module_release(pt3->adaps[i]->i2c_tuner);418err_demod_module_release:419 dvb_module_release(pt3->adaps[i]->i2c_demod);420 421 return ret;422}423 424 425static int pt3_fetch_thread(void *data)426{427 struct pt3_adapter *adap = data;428 ktime_t delay;429 bool was_frozen;430 431#define PT3_INITIAL_BUF_DROPS 4432#define PT3_FETCH_DELAY 10433#define PT3_FETCH_DELAY_DELTA 2434 435 pt3_init_dmabuf(adap);436 adap->num_discard = PT3_INITIAL_BUF_DROPS;437 438 dev_dbg(adap->dvb_adap.device, "PT3: [%s] started\n",439 adap->thread->comm);440 set_freezable();441 while (!kthread_freezable_should_stop(&was_frozen)) {442 if (was_frozen)443 adap->num_discard = PT3_INITIAL_BUF_DROPS;444 445 pt3_proc_dma(adap);446 447 delay = ktime_set(0, PT3_FETCH_DELAY * NSEC_PER_MSEC);448 set_current_state(TASK_UNINTERRUPTIBLE|TASK_FREEZABLE);449 schedule_hrtimeout_range(&delay,450 PT3_FETCH_DELAY_DELTA * NSEC_PER_MSEC,451 HRTIMER_MODE_REL);452 }453 dev_dbg(adap->dvb_adap.device, "PT3: [%s] exited\n",454 adap->thread->comm);455 return 0;456}457 458static int pt3_start_streaming(struct pt3_adapter *adap)459{460 struct task_struct *thread;461 462 /* start fetching thread */463 thread = kthread_run(pt3_fetch_thread, adap, "pt3-ad%i-dmx%i",464 adap->dvb_adap.num, adap->dmxdev.dvbdev->id);465 if (IS_ERR(thread)) {466 int ret = PTR_ERR(thread);467 468 adap->thread = NULL;469 dev_warn(adap->dvb_adap.device,470 "PT3 (adap:%d, dmx:%d): failed to start kthread\n",471 adap->dvb_adap.num, adap->dmxdev.dvbdev->id);472 return ret;473 }474 adap->thread = thread;475 476 return pt3_start_dma(adap);477}478 479static int pt3_stop_streaming(struct pt3_adapter *adap)480{481 int ret;482 483 ret = pt3_stop_dma(adap);484 if (ret)485 dev_warn(adap->dvb_adap.device,486 "PT3: failed to stop streaming of adap:%d/FE:%d\n",487 adap->dvb_adap.num, adap->fe->id);488 489 /* kill the fetching thread */490 ret = kthread_stop(adap->thread);491 adap->thread = NULL;492 return ret;493}494 495static int pt3_start_feed(struct dvb_demux_feed *feed)496{497 struct pt3_adapter *adap;498 499 if (signal_pending(current))500 return -EINTR;501 502 adap = container_of(feed->demux, struct pt3_adapter, demux);503 adap->num_feeds++;504 if (adap->num_feeds > 1)505 return 0;506 507 return pt3_start_streaming(adap);508 509}510 511static int pt3_stop_feed(struct dvb_demux_feed *feed)512{513 struct pt3_adapter *adap;514 515 adap = container_of(feed->demux, struct pt3_adapter, demux);516 517 adap->num_feeds--;518 if (adap->num_feeds > 0 || !adap->thread)519 return 0;520 adap->num_feeds = 0;521 522 return pt3_stop_streaming(adap);523}524 525 526static int pt3_alloc_adapter(struct pt3_board *pt3, int index)527{528 int ret;529 struct pt3_adapter *adap;530 struct dvb_adapter *da;531 532 adap = kzalloc(sizeof(*adap), GFP_KERNEL);533 if (!adap)534 return -ENOMEM;535 536 pt3->adaps[index] = adap;537 adap->adap_idx = index;538 539 if (index == 0 || !one_adapter) {540 ret = dvb_register_adapter(&adap->dvb_adap, "PT3 DVB",541 THIS_MODULE, &pt3->pdev->dev, adapter_nr);542 if (ret < 0) {543 dev_err(&pt3->pdev->dev,544 "failed to register adapter dev\n");545 goto err_mem;546 }547 da = &adap->dvb_adap;548 } else549 da = &pt3->adaps[0]->dvb_adap;550 551 adap->dvb_adap.priv = pt3;552 adap->demux.dmx.capabilities = DMX_TS_FILTERING | DMX_SECTION_FILTERING;553 adap->demux.priv = adap;554 adap->demux.feednum = 256;555 adap->demux.filternum = 256;556 adap->demux.start_feed = pt3_start_feed;557 adap->demux.stop_feed = pt3_stop_feed;558 ret = dvb_dmx_init(&adap->demux);559 if (ret < 0) {560 dev_err(&pt3->pdev->dev, "failed to init dmx dev\n");561 goto err_adap;562 }563 564 adap->dmxdev.filternum = 256;565 adap->dmxdev.demux = &adap->demux.dmx;566 ret = dvb_dmxdev_init(&adap->dmxdev, da);567 if (ret < 0) {568 dev_err(&pt3->pdev->dev, "failed to init dmxdev\n");569 goto err_demux;570 }571 572 ret = pt3_alloc_dmabuf(adap);573 if (ret) {574 dev_err(&pt3->pdev->dev, "failed to alloc DMA buffers\n");575 goto err_dmabuf;576 }577 578 return 0;579 580err_dmabuf:581 pt3_free_dmabuf(adap);582 dvb_dmxdev_release(&adap->dmxdev);583err_demux:584 dvb_dmx_release(&adap->demux);585err_adap:586 if (index == 0 || !one_adapter)587 dvb_unregister_adapter(da);588err_mem:589 kfree(adap);590 pt3->adaps[index] = NULL;591 return ret;592}593 594static void pt3_cleanup_adapter(struct pt3_board *pt3, int index)595{596 struct pt3_adapter *adap;597 struct dmx_demux *dmx;598 599 adap = pt3->adaps[index];600 if (adap == NULL)601 return;602 603 /* stop demux kthread */604 if (adap->thread)605 pt3_stop_streaming(adap);606 607 dmx = &adap->demux.dmx;608 dmx->close(dmx);609 if (adap->fe) {610 adap->fe->callback = NULL;611 if (adap->fe->frontend_priv)612 dvb_unregister_frontend(adap->fe);613 dvb_module_release(adap->i2c_tuner);614 dvb_module_release(adap->i2c_demod);615 }616 pt3_free_dmabuf(adap);617 dvb_dmxdev_release(&adap->dmxdev);618 dvb_dmx_release(&adap->demux);619 if (index == 0 || !one_adapter)620 dvb_unregister_adapter(&adap->dvb_adap);621 kfree(adap);622 pt3->adaps[index] = NULL;623}624 625#ifdef CONFIG_PM_SLEEP626 627static int pt3_suspend(struct device *dev)628{629 struct pt3_board *pt3 = dev_get_drvdata(dev);630 int i;631 struct pt3_adapter *adap;632 633 for (i = 0; i < PT3_NUM_FE; i++) {634 adap = pt3->adaps[i];635 if (adap->num_feeds > 0)636 pt3_stop_dma(adap);637 dvb_frontend_suspend(adap->fe);638 pt3_free_dmabuf(adap);639 }640 641 pt3_lnb_ctrl(pt3, false);642 pt3_set_tuner_power(pt3, false, false);643 return 0;644}645 646static int pt3_resume(struct device *dev)647{648 struct pt3_board *pt3 = dev_get_drvdata(dev);649 int i, ret;650 struct pt3_adapter *adap;651 652 ret = pt3_fe_init(pt3);653 if (ret)654 return ret;655 656 if (pt3->lna_on_cnt > 0)657 pt3_set_tuner_power(pt3, true, true);658 if (pt3->lnb_on_cnt > 0)659 pt3_lnb_ctrl(pt3, true);660 661 for (i = 0; i < PT3_NUM_FE; i++) {662 adap = pt3->adaps[i];663 dvb_frontend_resume(adap->fe);664 ret = pt3_alloc_dmabuf(adap);665 if (ret) {666 dev_err(&pt3->pdev->dev, "failed to alloc DMA bufs\n");667 continue;668 }669 if (adap->num_feeds > 0)670 pt3_start_dma(adap);671 }672 673 return 0;674}675 676#endif /* CONFIG_PM_SLEEP */677 678 679static void pt3_remove(struct pci_dev *pdev)680{681 struct pt3_board *pt3;682 int i;683 684 pt3 = pci_get_drvdata(pdev);685 for (i = PT3_NUM_FE - 1; i >= 0; i--)686 pt3_cleanup_adapter(pt3, i);687 i2c_del_adapter(&pt3->i2c_adap);688}689 690static int pt3_probe(struct pci_dev *pdev, const struct pci_device_id *ent)691{692 u8 rev;693 u32 ver;694 int i, ret;695 struct pt3_board *pt3;696 struct i2c_adapter *i2c;697 698 if (pci_read_config_byte(pdev, PCI_REVISION_ID, &rev) || rev != 1)699 return -ENODEV;700 701 ret = pcim_enable_device(pdev);702 if (ret < 0)703 return -ENODEV;704 pci_set_master(pdev);705 706 ret = pcim_iomap_regions(pdev, BIT(0) | BIT(2), DRV_NAME);707 if (ret < 0)708 return ret;709 710 ret = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));711 if (ret) {712 dev_err(&pdev->dev, "Failed to set DMA mask\n");713 return ret;714 }715 716 pt3 = devm_kzalloc(&pdev->dev, sizeof(*pt3), GFP_KERNEL);717 if (!pt3)718 return -ENOMEM;719 pci_set_drvdata(pdev, pt3);720 pt3->pdev = pdev;721 mutex_init(&pt3->lock);722 pt3->regs[0] = pcim_iomap_table(pdev)[0];723 pt3->regs[1] = pcim_iomap_table(pdev)[2];724 725 ver = ioread32(pt3->regs[0] + REG_VERSION);726 if ((ver >> 16) != 0x0301) {727 dev_warn(&pdev->dev, "PT%d, I/F-ver.:%d not supported\n",728 ver >> 24, (ver & 0x00ff0000) >> 16);729 return -ENODEV;730 }731 732 pt3->num_bufs = clamp_val(num_bufs, MIN_DATA_BUFS, MAX_DATA_BUFS);733 734 pt3->i2c_buf = devm_kmalloc(&pdev->dev, sizeof(*pt3->i2c_buf), GFP_KERNEL);735 if (!pt3->i2c_buf)736 return -ENOMEM;737 i2c = &pt3->i2c_adap;738 i2c->owner = THIS_MODULE;739 i2c->algo = &pt3_i2c_algo;740 i2c->algo_data = NULL;741 i2c->dev.parent = &pdev->dev;742 strscpy(i2c->name, DRV_NAME, sizeof(i2c->name));743 i2c_set_adapdata(i2c, pt3);744 ret = i2c_add_adapter(i2c);745 if (ret < 0)746 return ret;747 748 for (i = 0; i < PT3_NUM_FE; i++) {749 ret = pt3_alloc_adapter(pt3, i);750 if (ret < 0)751 break;752 753 ret = pt3_attach_fe(pt3, i);754 if (ret < 0)755 break;756 }757 if (i < PT3_NUM_FE) {758 dev_err(&pdev->dev, "Failed to create FE%d\n", i);759 goto err_cleanup_adapters;760 }761 762 ret = pt3_fe_init(pt3);763 if (ret < 0) {764 dev_err(&pdev->dev, "Failed to init frontends\n");765 i = PT3_NUM_FE - 1;766 goto err_cleanup_adapters;767 }768 769 dev_info(&pdev->dev,770 "successfully init'ed PT%d (fw:0x%02x, I/F:0x%02x)\n",771 ver >> 24, (ver >> 8) & 0xff, (ver >> 16) & 0xff);772 return 0;773 774err_cleanup_adapters:775 while (i >= 0)776 pt3_cleanup_adapter(pt3, i--);777 i2c_del_adapter(i2c);778 return ret;779}780 781static const struct pci_device_id pt3_id_table[] = {782 { PCI_DEVICE_SUB(0x1172, 0x4c15, 0xee8d, 0x0368) },783 { },784};785MODULE_DEVICE_TABLE(pci, pt3_id_table);786 787static SIMPLE_DEV_PM_OPS(pt3_pm_ops, pt3_suspend, pt3_resume);788 789static struct pci_driver pt3_driver = {790 .name = DRV_NAME,791 .probe = pt3_probe,792 .remove = pt3_remove,793 .id_table = pt3_id_table,794 795 .driver.pm = &pt3_pm_ops,796};797 798module_pci_driver(pt3_driver);799 800MODULE_DESCRIPTION("Earthsoft PT3 Driver");801MODULE_AUTHOR("Akihiro TSUKADA");802MODULE_LICENSE("GPL");803