1
2
3
4
5
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 int
92pt3_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
133
134
135
136static int
137pt3_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
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 else
168 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 } else
177 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
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 else
202 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
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
235
236
237
238
239
240
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
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 else
262 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
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 else
288 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
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
323
324
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
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
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 else
358 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 4
432#define PT3_FETCH_DELAY 10
433#define PT3_FETCH_DELAY_DELTA 2
434
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);
449 freezable_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
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
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 } else
549 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
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_SLEEP
626
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
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 kfree(pt3->i2c_buf);
689 pci_iounmap(pt3->pdev, pt3->regs[0]);
690 pci_iounmap(pt3->pdev, pt3->regs[1]);
691 pci_release_regions(pdev);
692 pci_disable_device(pdev);
693 kfree(pt3);
694}
695
696static int pt3_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
697{
698 u8 rev;
699 u32 ver;
700 int i, ret;
701 struct pt3_board *pt3;
702 struct i2c_adapter *i2c;
703
704 if (pci_read_config_byte(pdev, PCI_REVISION_ID, &rev) || rev != 1)
705 return -ENODEV;
706
707 ret = pci_enable_device(pdev);
708 if (ret < 0)
709 return -ENODEV;
710 pci_set_master(pdev);
711
712 ret = pci_request_regions(pdev, DRV_NAME);
713 if (ret < 0)
714 goto err_disable_device;
715
716 ret = dma_set_mask(&pdev->dev, DMA_BIT_MASK(64));
717 if (ret == 0)
718 dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(64));
719 else {
720 ret = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32));
721 if (ret == 0)
722 dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(32));
723 else {
724 dev_err(&pdev->dev, "Failed to set DMA mask\n");
725 goto err_release_regions;
726 }
727 dev_info(&pdev->dev, "Use 32bit DMA\n");
728 }
729
730 pt3 = kzalloc(sizeof(*pt3), GFP_KERNEL);
731 if (!pt3) {
732 ret = -ENOMEM;
733 goto err_release_regions;
734 }
735 pci_set_drvdata(pdev, pt3);
736 pt3->pdev = pdev;
737 mutex_init(&pt3->lock);
738 pt3->regs[0] = pci_ioremap_bar(pdev, 0);
739 pt3->regs[1] = pci_ioremap_bar(pdev, 2);
740 if (pt3->regs[0] == NULL || pt3->regs[1] == NULL) {
741 dev_err(&pdev->dev, "Failed to ioremap\n");
742 ret = -ENOMEM;
743 goto err_kfree;
744 }
745
746 ver = ioread32(pt3->regs[0] + REG_VERSION);
747 if ((ver >> 16) != 0x0301) {
748 dev_warn(&pdev->dev, "PT%d, I/F-ver.:%d not supported\n",
749 ver >> 24, (ver & 0x00ff0000) >> 16);
750 ret = -ENODEV;
751 goto err_iounmap;
752 }
753
754 pt3->num_bufs = clamp_val(num_bufs, MIN_DATA_BUFS, MAX_DATA_BUFS);
755
756 pt3->i2c_buf = kmalloc(sizeof(*pt3->i2c_buf), GFP_KERNEL);
757 if (pt3->i2c_buf == NULL) {
758 ret = -ENOMEM;
759 goto err_iounmap;
760 }
761 i2c = &pt3->i2c_adap;
762 i2c->owner = THIS_MODULE;
763 i2c->algo = &pt3_i2c_algo;
764 i2c->algo_data = NULL;
765 i2c->dev.parent = &pdev->dev;
766 strscpy(i2c->name, DRV_NAME, sizeof(i2c->name));
767 i2c_set_adapdata(i2c, pt3);
768 ret = i2c_add_adapter(i2c);
769 if (ret < 0)
770 goto err_i2cbuf;
771
772 for (i = 0; i < PT3_NUM_FE; i++) {
773 ret = pt3_alloc_adapter(pt3, i);
774 if (ret < 0)
775 break;
776
777 ret = pt3_attach_fe(pt3, i);
778 if (ret < 0)
779 break;
780 }
781 if (i < PT3_NUM_FE) {
782 dev_err(&pdev->dev, "Failed to create FE%d\n", i);
783 goto err_cleanup_adapters;
784 }
785
786 ret = pt3_fe_init(pt3);
787 if (ret < 0) {
788 dev_err(&pdev->dev, "Failed to init frontends\n");
789 i = PT3_NUM_FE - 1;
790 goto err_cleanup_adapters;
791 }
792
793 dev_info(&pdev->dev,
794 "successfully init'ed PT%d (fw:0x%02x, I/F:0x%02x)\n",
795 ver >> 24, (ver >> 8) & 0xff, (ver >> 16) & 0xff);
796 return 0;
797
798err_cleanup_adapters:
799 while (i >= 0)
800 pt3_cleanup_adapter(pt3, i--);
801 i2c_del_adapter(i2c);
802err_i2cbuf:
803 kfree(pt3->i2c_buf);
804err_iounmap:
805 if (pt3->regs[0])
806 pci_iounmap(pdev, pt3->regs[0]);
807 if (pt3->regs[1])
808 pci_iounmap(pdev, pt3->regs[1]);
809err_kfree:
810 kfree(pt3);
811err_release_regions:
812 pci_release_regions(pdev);
813err_disable_device:
814 pci_disable_device(pdev);
815 return ret;
816
817}
818
819static const struct pci_device_id pt3_id_table[] = {
820 { PCI_DEVICE_SUB(0x1172, 0x4c15, 0xee8d, 0x0368) },
821 { },
822};
823MODULE_DEVICE_TABLE(pci, pt3_id_table);
824
825static SIMPLE_DEV_PM_OPS(pt3_pm_ops, pt3_suspend, pt3_resume);
826
827static struct pci_driver pt3_driver = {
828 .name = DRV_NAME,
829 .probe = pt3_probe,
830 .remove = pt3_remove,
831 .id_table = pt3_id_table,
832
833 .driver.pm = &pt3_pm_ops,
834};
835
836module_pci_driver(pt3_driver);
837
838MODULE_DESCRIPTION("Earthsoft PT3 Driver");
839MODULE_AUTHOR("Akihiro TSUKADA");
840MODULE_LICENSE("GPL");
841
