2 * driver for Earthsoft PT1/PT2
4 * Copyright (C) 2009 HIRANO Takahito <hiranotaka@zng.info>
6 * based on pt1dvr - http://pt1dvr.sourceforge.jp/
7 * by Tomoaki Ishikawa <tomy@users.sourceforge.jp>
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
20 #include <linux/kernel.h>
21 #include <linux/module.h>
22 #include <linux/slab.h>
23 #include <linux/vmalloc.h>
24 #include <linux/pci.h>
25 #include <linux/kthread.h>
26 #include <linux/freezer.h>
27 #include <linux/ratelimit.h>
30 #include "dvb_demux.h"
33 #include "dvb_frontend.h"
35 #include "va1j5jf8007t.h"
36 #include "va1j5jf8007s.h"
38 #define DRIVER_NAME "earth-pt1"
40 #define PT1_PAGE_SHIFT 12
41 #define PT1_PAGE_SIZE (1 << PT1_PAGE_SHIFT)
42 #define PT1_NR_UPACKETS 1024
43 #define PT1_NR_BUFS 511
45 struct pt1_buffer_page {
46 __le32 upackets[PT1_NR_UPACKETS];
49 struct pt1_table_page {
51 __le32 buf_pfns[PT1_NR_BUFS];
55 struct pt1_buffer_page *page;
60 struct pt1_table_page *page;
62 struct pt1_buffer bufs[PT1_NR_BUFS];
65 #define PT1_NR_ADAPS 4
72 struct i2c_adapter i2c_adap;
74 struct pt1_adapter *adaps[PT1_NR_ADAPS];
75 struct pt1_table *tables;
76 struct task_struct *kthread;
94 struct dvb_adapter adap;
95 struct dvb_demux demux;
98 struct dvb_frontend *fe;
99 int (*orig_set_voltage)(struct dvb_frontend *fe,
100 enum fe_sec_voltage voltage);
101 int (*orig_sleep)(struct dvb_frontend *fe);
102 int (*orig_init)(struct dvb_frontend *fe);
104 enum fe_sec_voltage voltage;
108 static void pt1_write_reg(struct pt1 *pt1, int reg, u32 data)
110 writel(data, pt1->regs + reg * 4);
113 static u32 pt1_read_reg(struct pt1 *pt1, int reg)
115 return readl(pt1->regs + reg * 4);
118 static int pt1_nr_tables = 8;
119 module_param_named(nr_tables, pt1_nr_tables, int, 0);
121 static void pt1_increment_table_count(struct pt1 *pt1)
123 pt1_write_reg(pt1, 0, 0x00000020);
126 static void pt1_init_table_count(struct pt1 *pt1)
128 pt1_write_reg(pt1, 0, 0x00000010);
131 static void pt1_register_tables(struct pt1 *pt1, u32 first_pfn)
133 pt1_write_reg(pt1, 5, first_pfn);
134 pt1_write_reg(pt1, 0, 0x0c000040);
137 static void pt1_unregister_tables(struct pt1 *pt1)
139 pt1_write_reg(pt1, 0, 0x08080000);
142 static int pt1_sync(struct pt1 *pt1)
145 for (i = 0; i < 57; i++) {
146 if (pt1_read_reg(pt1, 0) & 0x20000000)
148 pt1_write_reg(pt1, 0, 0x00000008);
150 dev_err(&pt1->pdev->dev, "could not sync\n");
154 static u64 pt1_identify(struct pt1 *pt1)
159 for (i = 0; i < 57; i++) {
160 id |= (u64)(pt1_read_reg(pt1, 0) >> 30 & 1) << i;
161 pt1_write_reg(pt1, 0, 0x00000008);
166 static int pt1_unlock(struct pt1 *pt1)
169 pt1_write_reg(pt1, 0, 0x00000008);
170 for (i = 0; i < 3; i++) {
171 if (pt1_read_reg(pt1, 0) & 0x80000000)
173 schedule_timeout_uninterruptible((HZ + 999) / 1000);
175 dev_err(&pt1->pdev->dev, "could not unlock\n");
179 static int pt1_reset_pci(struct pt1 *pt1)
182 pt1_write_reg(pt1, 0, 0x01010000);
183 pt1_write_reg(pt1, 0, 0x01000000);
184 for (i = 0; i < 10; i++) {
185 if (pt1_read_reg(pt1, 0) & 0x00000001)
187 schedule_timeout_uninterruptible((HZ + 999) / 1000);
189 dev_err(&pt1->pdev->dev, "could not reset PCI\n");
193 static int pt1_reset_ram(struct pt1 *pt1)
196 pt1_write_reg(pt1, 0, 0x02020000);
197 pt1_write_reg(pt1, 0, 0x02000000);
198 for (i = 0; i < 10; i++) {
199 if (pt1_read_reg(pt1, 0) & 0x00000002)
201 schedule_timeout_uninterruptible((HZ + 999) / 1000);
203 dev_err(&pt1->pdev->dev, "could not reset RAM\n");
207 static int pt1_do_enable_ram(struct pt1 *pt1)
211 status = pt1_read_reg(pt1, 0) & 0x00000004;
212 pt1_write_reg(pt1, 0, 0x00000002);
213 for (i = 0; i < 10; i++) {
214 for (j = 0; j < 1024; j++) {
215 if ((pt1_read_reg(pt1, 0) & 0x00000004) != status)
218 schedule_timeout_uninterruptible((HZ + 999) / 1000);
220 dev_err(&pt1->pdev->dev, "could not enable RAM\n");
224 static int pt1_enable_ram(struct pt1 *pt1)
228 schedule_timeout_uninterruptible((HZ + 999) / 1000);
229 phase = pt1->pdev->device == 0x211a ? 128 : 166;
230 for (i = 0; i < phase; i++) {
231 ret = pt1_do_enable_ram(pt1);
238 static void pt1_disable_ram(struct pt1 *pt1)
240 pt1_write_reg(pt1, 0, 0x0b0b0000);
243 static void pt1_set_stream(struct pt1 *pt1, int index, int enabled)
245 pt1_write_reg(pt1, 2, 1 << (index + 8) | enabled << index);
248 static void pt1_init_streams(struct pt1 *pt1)
251 for (i = 0; i < PT1_NR_ADAPS; i++)
252 pt1_set_stream(pt1, i, 0);
255 static int pt1_filter(struct pt1 *pt1, struct pt1_buffer_page *page)
260 struct pt1_adapter *adap;
265 if (!page->upackets[PT1_NR_UPACKETS - 1])
268 for (i = 0; i < PT1_NR_UPACKETS; i++) {
269 upacket = le32_to_cpu(page->upackets[i]);
270 index = (upacket >> 29) - 1;
271 if (index < 0 || index >= PT1_NR_ADAPS)
274 adap = pt1->adaps[index];
275 if (upacket >> 25 & 1)
276 adap->upacket_count = 0;
277 else if (!adap->upacket_count)
280 if (upacket >> 24 & 1)
281 printk_ratelimited(KERN_INFO "earth-pt1: device buffer overflowing. table[%d] buf[%d]\n",
282 pt1->table_index, pt1->buf_index);
283 sc = upacket >> 26 & 0x7;
284 if (adap->st_count != -1 && sc != ((adap->st_count + 1) & 0x7))
285 printk_ratelimited(KERN_INFO "earth-pt1: data loss in streamID(adapter)[%d]\n",
290 offset = adap->packet_count * 188 + adap->upacket_count * 3;
291 buf[offset] = upacket >> 16;
292 buf[offset + 1] = upacket >> 8;
293 if (adap->upacket_count != 62)
294 buf[offset + 2] = upacket;
296 if (++adap->upacket_count >= 63) {
297 adap->upacket_count = 0;
298 if (++adap->packet_count >= 21) {
299 dvb_dmx_swfilter_packets(&adap->demux, buf, 21);
300 adap->packet_count = 0;
305 page->upackets[PT1_NR_UPACKETS - 1] = 0;
309 static int pt1_thread(void *data)
312 struct pt1_buffer_page *page;
317 while (!kthread_should_stop()) {
320 page = pt1->tables[pt1->table_index].bufs[pt1->buf_index].page;
321 if (!pt1_filter(pt1, page)) {
322 schedule_timeout_interruptible((HZ + 999) / 1000);
326 if (++pt1->buf_index >= PT1_NR_BUFS) {
327 pt1_increment_table_count(pt1);
329 if (++pt1->table_index >= pt1_nr_tables)
330 pt1->table_index = 0;
337 static void pt1_free_page(struct pt1 *pt1, void *page, dma_addr_t addr)
339 dma_free_coherent(&pt1->pdev->dev, PT1_PAGE_SIZE, page, addr);
342 static void *pt1_alloc_page(struct pt1 *pt1, dma_addr_t *addrp, u32 *pfnp)
347 page = dma_alloc_coherent(&pt1->pdev->dev, PT1_PAGE_SIZE, &addr,
352 BUG_ON(addr & (PT1_PAGE_SIZE - 1));
353 BUG_ON(addr >> PT1_PAGE_SHIFT >> 31 >> 1);
356 *pfnp = addr >> PT1_PAGE_SHIFT;
360 static void pt1_cleanup_buffer(struct pt1 *pt1, struct pt1_buffer *buf)
362 pt1_free_page(pt1, buf->page, buf->addr);
366 pt1_init_buffer(struct pt1 *pt1, struct pt1_buffer *buf, u32 *pfnp)
368 struct pt1_buffer_page *page;
371 page = pt1_alloc_page(pt1, &addr, pfnp);
375 page->upackets[PT1_NR_UPACKETS - 1] = 0;
382 static void pt1_cleanup_table(struct pt1 *pt1, struct pt1_table *table)
386 for (i = 0; i < PT1_NR_BUFS; i++)
387 pt1_cleanup_buffer(pt1, &table->bufs[i]);
389 pt1_free_page(pt1, table->page, table->addr);
393 pt1_init_table(struct pt1 *pt1, struct pt1_table *table, u32 *pfnp)
395 struct pt1_table_page *page;
400 page = pt1_alloc_page(pt1, &addr, pfnp);
404 for (i = 0; i < PT1_NR_BUFS; i++) {
405 ret = pt1_init_buffer(pt1, &table->bufs[i], &buf_pfn);
409 page->buf_pfns[i] = cpu_to_le32(buf_pfn);
412 pt1_increment_table_count(pt1);
419 pt1_cleanup_buffer(pt1, &table->bufs[i]);
421 pt1_free_page(pt1, page, addr);
425 static void pt1_cleanup_tables(struct pt1 *pt1)
427 struct pt1_table *tables;
430 tables = pt1->tables;
431 pt1_unregister_tables(pt1);
433 for (i = 0; i < pt1_nr_tables; i++)
434 pt1_cleanup_table(pt1, &tables[i]);
439 static int pt1_init_tables(struct pt1 *pt1)
441 struct pt1_table *tables;
445 tables = vmalloc(sizeof(struct pt1_table) * pt1_nr_tables);
449 pt1_init_table_count(pt1);
453 ret = pt1_init_table(pt1, &tables[0], &first_pfn);
459 while (i < pt1_nr_tables) {
460 ret = pt1_init_table(pt1, &tables[i], &pfn);
463 tables[i - 1].page->next_pfn = cpu_to_le32(pfn);
467 tables[pt1_nr_tables - 1].page->next_pfn = cpu_to_le32(first_pfn);
469 pt1_register_tables(pt1, first_pfn);
470 pt1->tables = tables;
475 pt1_cleanup_table(pt1, &tables[i]);
481 static int pt1_start_polling(struct pt1 *pt1)
485 mutex_lock(&pt1->lock);
487 pt1->kthread = kthread_run(pt1_thread, pt1, "earth-pt1");
488 if (IS_ERR(pt1->kthread)) {
489 ret = PTR_ERR(pt1->kthread);
493 mutex_unlock(&pt1->lock);
497 static int pt1_start_feed(struct dvb_demux_feed *feed)
499 struct pt1_adapter *adap;
500 adap = container_of(feed->demux, struct pt1_adapter, demux);
501 if (!adap->users++) {
504 ret = pt1_start_polling(adap->pt1);
507 pt1_set_stream(adap->pt1, adap->index, 1);
512 static void pt1_stop_polling(struct pt1 *pt1)
516 mutex_lock(&pt1->lock);
517 for (i = 0, count = 0; i < PT1_NR_ADAPS; i++)
518 count += pt1->adaps[i]->users;
520 if (count == 0 && pt1->kthread) {
521 kthread_stop(pt1->kthread);
524 mutex_unlock(&pt1->lock);
527 static int pt1_stop_feed(struct dvb_demux_feed *feed)
529 struct pt1_adapter *adap;
530 adap = container_of(feed->demux, struct pt1_adapter, demux);
531 if (!--adap->users) {
532 pt1_set_stream(adap->pt1, adap->index, 0);
533 pt1_stop_polling(adap->pt1);
539 pt1_update_power(struct pt1 *pt1)
543 struct pt1_adapter *adap;
544 static const int sleep_bits[] = {
551 bits = pt1->power | !pt1->reset << 3;
552 mutex_lock(&pt1->lock);
553 for (i = 0; i < PT1_NR_ADAPS; i++) {
554 adap = pt1->adaps[i];
555 switch (adap->voltage) {
556 case SEC_VOLTAGE_13: /* actually 11V */
559 case SEC_VOLTAGE_18: /* actually 15V */
560 bits |= 1 << 1 | 1 << 2;
566 /* XXX: The bits should be changed depending on adap->sleep. */
567 bits |= sleep_bits[i];
569 pt1_write_reg(pt1, 1, bits);
570 mutex_unlock(&pt1->lock);
573 static int pt1_set_voltage(struct dvb_frontend *fe, enum fe_sec_voltage voltage)
575 struct pt1_adapter *adap;
577 adap = container_of(fe->dvb, struct pt1_adapter, adap);
578 adap->voltage = voltage;
579 pt1_update_power(adap->pt1);
581 if (adap->orig_set_voltage)
582 return adap->orig_set_voltage(fe, voltage);
587 static int pt1_sleep(struct dvb_frontend *fe)
589 struct pt1_adapter *adap;
591 adap = container_of(fe->dvb, struct pt1_adapter, adap);
593 pt1_update_power(adap->pt1);
595 if (adap->orig_sleep)
596 return adap->orig_sleep(fe);
601 static int pt1_wakeup(struct dvb_frontend *fe)
603 struct pt1_adapter *adap;
605 adap = container_of(fe->dvb, struct pt1_adapter, adap);
607 pt1_update_power(adap->pt1);
608 schedule_timeout_uninterruptible((HZ + 999) / 1000);
611 return adap->orig_init(fe);
616 static void pt1_free_adapter(struct pt1_adapter *adap)
618 adap->demux.dmx.close(&adap->demux.dmx);
619 dvb_dmxdev_release(&adap->dmxdev);
620 dvb_dmx_release(&adap->demux);
621 dvb_unregister_adapter(&adap->adap);
622 free_page((unsigned long)adap->buf);
626 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
628 static struct pt1_adapter *
629 pt1_alloc_adapter(struct pt1 *pt1)
631 struct pt1_adapter *adap;
633 struct dvb_adapter *dvb_adap;
634 struct dvb_demux *demux;
635 struct dmxdev *dmxdev;
638 adap = kzalloc(sizeof(struct pt1_adapter), GFP_KERNEL);
646 adap->voltage = SEC_VOLTAGE_OFF;
649 buf = (u8 *)__get_free_page(GFP_KERNEL);
656 adap->upacket_count = 0;
657 adap->packet_count = 0;
660 dvb_adap = &adap->adap;
661 dvb_adap->priv = adap;
662 ret = dvb_register_adapter(dvb_adap, DRIVER_NAME, THIS_MODULE,
663 &pt1->pdev->dev, adapter_nr);
667 demux = &adap->demux;
668 demux->dmx.capabilities = DMX_TS_FILTERING | DMX_SECTION_FILTERING;
670 demux->feednum = 256;
671 demux->filternum = 256;
672 demux->start_feed = pt1_start_feed;
673 demux->stop_feed = pt1_stop_feed;
674 demux->write_to_decoder = NULL;
675 ret = dvb_dmx_init(demux);
677 goto err_unregister_adapter;
679 dmxdev = &adap->dmxdev;
680 dmxdev->filternum = 256;
681 dmxdev->demux = &demux->dmx;
682 dmxdev->capabilities = 0;
683 ret = dvb_dmxdev_init(dmxdev, dvb_adap);
685 goto err_dmx_release;
690 dvb_dmx_release(demux);
691 err_unregister_adapter:
692 dvb_unregister_adapter(dvb_adap);
694 free_page((unsigned long)buf);
701 static void pt1_cleanup_adapters(struct pt1 *pt1)
704 for (i = 0; i < PT1_NR_ADAPS; i++)
705 pt1_free_adapter(pt1->adaps[i]);
708 static int pt1_init_adapters(struct pt1 *pt1)
711 struct pt1_adapter *adap;
714 for (i = 0; i < PT1_NR_ADAPS; i++) {
715 adap = pt1_alloc_adapter(pt1);
722 pt1->adaps[i] = adap;
728 pt1_free_adapter(pt1->adaps[i]);
733 static void pt1_cleanup_frontend(struct pt1_adapter *adap)
735 dvb_unregister_frontend(adap->fe);
738 static int pt1_init_frontend(struct pt1_adapter *adap, struct dvb_frontend *fe)
742 adap->orig_set_voltage = fe->ops.set_voltage;
743 adap->orig_sleep = fe->ops.sleep;
744 adap->orig_init = fe->ops.init;
745 fe->ops.set_voltage = pt1_set_voltage;
746 fe->ops.sleep = pt1_sleep;
747 fe->ops.init = pt1_wakeup;
749 ret = dvb_register_frontend(&adap->adap, fe);
757 static void pt1_cleanup_frontends(struct pt1 *pt1)
760 for (i = 0; i < PT1_NR_ADAPS; i++)
761 pt1_cleanup_frontend(pt1->adaps[i]);
765 struct va1j5jf8007s_config va1j5jf8007s_config;
766 struct va1j5jf8007t_config va1j5jf8007t_config;
769 static const struct pt1_config pt1_configs[2] = {
772 .demod_address = 0x1b,
773 .frequency = VA1J5JF8007S_20MHZ,
776 .demod_address = 0x1a,
777 .frequency = VA1J5JF8007T_20MHZ,
781 .demod_address = 0x19,
782 .frequency = VA1J5JF8007S_20MHZ,
785 .demod_address = 0x18,
786 .frequency = VA1J5JF8007T_20MHZ,
791 static const struct pt1_config pt2_configs[2] = {
794 .demod_address = 0x1b,
795 .frequency = VA1J5JF8007S_25MHZ,
798 .demod_address = 0x1a,
799 .frequency = VA1J5JF8007T_25MHZ,
803 .demod_address = 0x19,
804 .frequency = VA1J5JF8007S_25MHZ,
807 .demod_address = 0x18,
808 .frequency = VA1J5JF8007T_25MHZ,
813 static int pt1_init_frontends(struct pt1 *pt1)
816 struct i2c_adapter *i2c_adap;
817 const struct pt1_config *configs, *config;
818 struct dvb_frontend *fe[4];
824 i2c_adap = &pt1->i2c_adap;
825 configs = pt1->pdev->device == 0x211a ? pt1_configs : pt2_configs;
827 config = &configs[i / 2];
829 fe[i] = va1j5jf8007s_attach(&config->va1j5jf8007s_config,
832 ret = -ENODEV; /* This does not sound nice... */
837 fe[i] = va1j5jf8007t_attach(&config->va1j5jf8007t_config,
845 ret = va1j5jf8007s_prepare(fe[i - 2]);
849 ret = va1j5jf8007t_prepare(fe[i - 1]);
856 ret = pt1_init_frontend(pt1->adaps[j], fe[j]);
865 fe[i]->ops.release(fe[i]);
868 dvb_unregister_frontend(fe[j]);
873 static void pt1_i2c_emit(struct pt1 *pt1, int addr, int busy, int read_enable,
874 int clock, int data, int next_addr)
876 pt1_write_reg(pt1, 4, addr << 18 | busy << 13 | read_enable << 12 |
877 !clock << 11 | !data << 10 | next_addr);
880 static void pt1_i2c_write_bit(struct pt1 *pt1, int addr, int *addrp, int data)
882 pt1_i2c_emit(pt1, addr, 1, 0, 0, data, addr + 1);
883 pt1_i2c_emit(pt1, addr + 1, 1, 0, 1, data, addr + 2);
884 pt1_i2c_emit(pt1, addr + 2, 1, 0, 0, data, addr + 3);
888 static void pt1_i2c_read_bit(struct pt1 *pt1, int addr, int *addrp)
890 pt1_i2c_emit(pt1, addr, 1, 0, 0, 1, addr + 1);
891 pt1_i2c_emit(pt1, addr + 1, 1, 0, 1, 1, addr + 2);
892 pt1_i2c_emit(pt1, addr + 2, 1, 1, 1, 1, addr + 3);
893 pt1_i2c_emit(pt1, addr + 3, 1, 0, 0, 1, addr + 4);
897 static void pt1_i2c_write_byte(struct pt1 *pt1, int addr, int *addrp, int data)
900 for (i = 0; i < 8; i++)
901 pt1_i2c_write_bit(pt1, addr, &addr, data >> (7 - i) & 1);
902 pt1_i2c_write_bit(pt1, addr, &addr, 1);
906 static void pt1_i2c_read_byte(struct pt1 *pt1, int addr, int *addrp, int last)
909 for (i = 0; i < 8; i++)
910 pt1_i2c_read_bit(pt1, addr, &addr);
911 pt1_i2c_write_bit(pt1, addr, &addr, last);
915 static void pt1_i2c_prepare(struct pt1 *pt1, int addr, int *addrp)
917 pt1_i2c_emit(pt1, addr, 1, 0, 1, 1, addr + 1);
918 pt1_i2c_emit(pt1, addr + 1, 1, 0, 1, 0, addr + 2);
919 pt1_i2c_emit(pt1, addr + 2, 1, 0, 0, 0, addr + 3);
924 pt1_i2c_write_msg(struct pt1 *pt1, int addr, int *addrp, struct i2c_msg *msg)
927 pt1_i2c_prepare(pt1, addr, &addr);
928 pt1_i2c_write_byte(pt1, addr, &addr, msg->addr << 1);
929 for (i = 0; i < msg->len; i++)
930 pt1_i2c_write_byte(pt1, addr, &addr, msg->buf[i]);
935 pt1_i2c_read_msg(struct pt1 *pt1, int addr, int *addrp, struct i2c_msg *msg)
938 pt1_i2c_prepare(pt1, addr, &addr);
939 pt1_i2c_write_byte(pt1, addr, &addr, msg->addr << 1 | 1);
940 for (i = 0; i < msg->len; i++)
941 pt1_i2c_read_byte(pt1, addr, &addr, i == msg->len - 1);
945 static int pt1_i2c_end(struct pt1 *pt1, int addr)
947 pt1_i2c_emit(pt1, addr, 1, 0, 0, 0, addr + 1);
948 pt1_i2c_emit(pt1, addr + 1, 1, 0, 1, 0, addr + 2);
949 pt1_i2c_emit(pt1, addr + 2, 1, 0, 1, 1, 0);
951 pt1_write_reg(pt1, 0, 0x00000004);
953 if (signal_pending(current))
955 schedule_timeout_interruptible((HZ + 999) / 1000);
956 } while (pt1_read_reg(pt1, 0) & 0x00000080);
960 static void pt1_i2c_begin(struct pt1 *pt1, int *addrp)
965 pt1_i2c_emit(pt1, addr, 0, 0, 1, 1, addr /* itself */);
968 if (!pt1->i2c_running) {
969 pt1_i2c_emit(pt1, addr, 1, 0, 1, 1, addr + 1);
970 pt1_i2c_emit(pt1, addr + 1, 1, 0, 1, 0, addr + 2);
972 pt1->i2c_running = 1;
977 static int pt1_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num)
981 struct i2c_msg *msg, *next_msg;
986 pt1 = i2c_get_adapdata(adap);
988 for (i = 0; i < num; i++) {
990 if (msg->flags & I2C_M_RD)
994 next_msg = &msgs[i + 1];
998 if (next_msg && next_msg->flags & I2C_M_RD) {
1001 len = next_msg->len;
1005 pt1_i2c_begin(pt1, &addr);
1006 pt1_i2c_write_msg(pt1, addr, &addr, msg);
1007 pt1_i2c_read_msg(pt1, addr, &addr, next_msg);
1008 ret = pt1_i2c_end(pt1, addr);
1012 word = pt1_read_reg(pt1, 2);
1014 next_msg->buf[len] = word;
1018 pt1_i2c_begin(pt1, &addr);
1019 pt1_i2c_write_msg(pt1, addr, &addr, msg);
1020 ret = pt1_i2c_end(pt1, addr);
1029 static u32 pt1_i2c_func(struct i2c_adapter *adap)
1031 return I2C_FUNC_I2C;
1034 static const struct i2c_algorithm pt1_i2c_algo = {
1035 .master_xfer = pt1_i2c_xfer,
1036 .functionality = pt1_i2c_func,
1039 static void pt1_i2c_wait(struct pt1 *pt1)
1042 for (i = 0; i < 128; i++)
1043 pt1_i2c_emit(pt1, 0, 0, 0, 1, 1, 0);
1046 static void pt1_i2c_init(struct pt1 *pt1)
1049 for (i = 0; i < 1024; i++)
1050 pt1_i2c_emit(pt1, i, 0, 0, 1, 1, 0);
1053 static void pt1_remove(struct pci_dev *pdev)
1058 pt1 = pci_get_drvdata(pdev);
1062 kthread_stop(pt1->kthread);
1063 pt1_cleanup_tables(pt1);
1064 pt1_cleanup_frontends(pt1);
1065 pt1_disable_ram(pt1);
1068 pt1_update_power(pt1);
1069 pt1_cleanup_adapters(pt1);
1070 i2c_del_adapter(&pt1->i2c_adap);
1072 pci_iounmap(pdev, regs);
1073 pci_release_regions(pdev);
1074 pci_disable_device(pdev);
1077 static int pt1_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
1082 struct i2c_adapter *i2c_adap;
1084 ret = pci_enable_device(pdev);
1088 ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
1090 goto err_pci_disable_device;
1092 pci_set_master(pdev);
1094 ret = pci_request_regions(pdev, DRIVER_NAME);
1096 goto err_pci_disable_device;
1098 regs = pci_iomap(pdev, 0, 0);
1101 goto err_pci_release_regions;
1104 pt1 = kzalloc(sizeof(struct pt1), GFP_KERNEL);
1107 goto err_pci_iounmap;
1110 mutex_init(&pt1->lock);
1113 pci_set_drvdata(pdev, pt1);
1115 ret = pt1_init_adapters(pt1);
1119 mutex_init(&pt1->lock);
1123 pt1_update_power(pt1);
1125 i2c_adap = &pt1->i2c_adap;
1126 i2c_adap->algo = &pt1_i2c_algo;
1127 i2c_adap->algo_data = NULL;
1128 i2c_adap->dev.parent = &pdev->dev;
1129 strcpy(i2c_adap->name, DRIVER_NAME);
1130 i2c_set_adapdata(i2c_adap, pt1);
1131 ret = i2c_add_adapter(i2c_adap);
1133 goto err_pt1_cleanup_adapters;
1138 ret = pt1_sync(pt1);
1140 goto err_i2c_del_adapter;
1144 ret = pt1_unlock(pt1);
1146 goto err_i2c_del_adapter;
1148 ret = pt1_reset_pci(pt1);
1150 goto err_i2c_del_adapter;
1152 ret = pt1_reset_ram(pt1);
1154 goto err_i2c_del_adapter;
1156 ret = pt1_enable_ram(pt1);
1158 goto err_i2c_del_adapter;
1160 pt1_init_streams(pt1);
1163 pt1_update_power(pt1);
1164 schedule_timeout_uninterruptible((HZ + 49) / 50);
1167 pt1_update_power(pt1);
1168 schedule_timeout_uninterruptible((HZ + 999) / 1000);
1170 ret = pt1_init_frontends(pt1);
1172 goto err_pt1_disable_ram;
1174 ret = pt1_init_tables(pt1);
1176 goto err_pt1_cleanup_frontends;
1180 err_pt1_cleanup_frontends:
1181 pt1_cleanup_frontends(pt1);
1182 err_pt1_disable_ram:
1183 pt1_disable_ram(pt1);
1186 pt1_update_power(pt1);
1187 err_i2c_del_adapter:
1188 i2c_del_adapter(i2c_adap);
1189 err_pt1_cleanup_adapters:
1190 pt1_cleanup_adapters(pt1);
1194 pci_iounmap(pdev, regs);
1195 err_pci_release_regions:
1196 pci_release_regions(pdev);
1197 err_pci_disable_device:
1198 pci_disable_device(pdev);
1204 static struct pci_device_id pt1_id_table[] = {
1205 { PCI_DEVICE(0x10ee, 0x211a) },
1206 { PCI_DEVICE(0x10ee, 0x222a) },
1209 MODULE_DEVICE_TABLE(pci, pt1_id_table);
1211 static struct pci_driver pt1_driver = {
1212 .name = DRIVER_NAME,
1214 .remove = pt1_remove,
1215 .id_table = pt1_id_table,
1218 module_pci_driver(pt1_driver);
1220 MODULE_AUTHOR("Takahito HIRANO <hiranotaka@zng.info>");
1221 MODULE_DESCRIPTION("Earthsoft PT1/PT2 Driver");
1222 MODULE_LICENSE("GPL");