Mercurial > pt1.oyama
annotate driver/pt1_pci.c @ 124:9c7bc6c0327e
Add DLNA server function test. (from uShare project)
author | naoyan@johnstown.minaminoshima.org |
---|---|
date | Wed, 29 Sep 2010 23:18:55 +0900 (2010-09-29) |
parents | c8cfd684fee8 |
children | 4303bbfd5d37 |
rev | line source |
---|---|
108
bc173c443e4d
make sure that wait after set_sleepmode()
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
102
diff
changeset
|
1 /* -*- tab-width: 4; indent-tabs-mode: t -*- */ |
0 | 2 /* pt1-pci.c: A PT1 on PCI bus driver for Linux. */ |
3 #define DRV_NAME "pt1-pci" | |
90
c6311b6efd9c
- version string should be generated upon revision on mercurial repository
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
86
diff
changeset
|
4 #include "version.h" |
0 | 5 |
6 #include <linux/module.h> | |
7 #include <linux/kernel.h> | |
8 #include <linux/errno.h> | |
9 #include <linux/pci.h> | |
10 #include <linux/init.h> | |
11 #include <linux/interrupt.h> | |
12 | |
13 #include <asm/system.h> | |
14 #include <asm/io.h> | |
15 #include <asm/irq.h> | |
16 #include <asm/uaccess.h> | |
17 #include <linux/version.h> | |
18 #include <linux/mutex.h> | |
36 | 19 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,23) |
0 | 20 #include <linux/freezer.h> |
21 #else | |
22 #define set_freezable() | |
36 | 23 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,11) |
0 | 24 typedef struct pm_message { |
25 int event; | |
26 } pm_message_t; | |
27 #endif | |
28 #endif | |
29 #include <linux/kthread.h> | |
30 #include <linux/dma-mapping.h> | |
31 | |
32 #include <linux/fs.h> | |
33 #include <linux/cdev.h> | |
34 | |
35 #include <linux/ioctl.h> | |
36 | |
37 #include "pt1_com.h" | |
38 #include "pt1_pci.h" | |
39 #include "pt1_tuner.h" | |
40 #include "pt1_i2c.h" | |
41 #include "pt1_tuner_data.h" | |
42 #include "pt1_ioctl.h" | |
43 | |
44 /* These identify the driver base version and may not be removed. */ | |
45 static char version[] __devinitdata = | |
93 | 46 DRV_NAME ".c: " DRV_VERSION " " DRV_RELDATE " \n"; |
0 | 47 |
90
c6311b6efd9c
- version string should be generated upon revision on mercurial repository
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
86
diff
changeset
|
48 MODULE_AUTHOR("Tomoaki Ishikawa tomy@users.sourceforge.jp and Yoshiki Yazawa yaz@honeyplanet.jp"); |
c6311b6efd9c
- version string should be generated upon revision on mercurial repository
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
86
diff
changeset
|
49 #define DRIVER_DESC "PCI earthsoft PT1/2 driver" |
0 | 50 MODULE_DESCRIPTION(DRIVER_DESC); |
51 MODULE_LICENSE("GPL"); | |
52 | |
51
c915076353ae
backout 23b6f99f65b2 for now. it may cause scheduling while atomic operation.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
50
diff
changeset
|
53 static int debug = 7; /* 1 normal messages, 0 quiet .. 7 verbose. */ |
c915076353ae
backout 23b6f99f65b2 for now. it may cause scheduling while atomic operation.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
50
diff
changeset
|
54 static int lnb = 0; /* LNB OFF:0 +11V:1 +15V:2 */ |
0 | 55 |
56 module_param(debug, int, 0); | |
57 module_param(lnb, int, 0); | |
58 MODULE_PARM_DESC(debug, "debug level (1-2)"); | |
59 MODULE_PARM_DESC(debug, "LNB level (0:OFF 1:+11V 2:+15V)"); | |
60 | |
64
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
61 #define VENDOR_EARTHSOFT 0x10ee |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
62 #define PCI_PT1_ID 0x211a |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
63 #define PCI_PT2_ID 0x222a |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
64 |
0 | 65 static struct pci_device_id pt1_pci_tbl[] = { |
64
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
66 { VENDOR_EARTHSOFT, PCI_PT1_ID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 }, |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
67 { VENDOR_EARTHSOFT, PCI_PT2_ID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 }, |
0 | 68 { 0, } |
69 }; | |
70 MODULE_DEVICE_TABLE(pci, pt1_pci_tbl); | |
71 #define DEV_NAME "pt1video" | |
72 | |
37
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
73 #define PACKET_SIZE 188 // 1パケット長 |
0 | 74 #define MAX_READ_BLOCK 4 // 1度に読み出す最大DMAバッファ数 |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
75 #define MAX_PCI_DEVICE 128 // 最大64枚 |
0 | 76 #define DMA_SIZE 4096 // DMAバッファサイズ |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
77 #define DMA_RING_SIZE 128 // RINGサイズ |
0 | 78 #define DMA_RING_MAX 511 // 1RINGにいくつ詰めるか(1023はNGで511まで) |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
79 #define CHANEL_DMA_SIZE (2*1024*1024) // 地デジ用(16Mbps) |
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
80 #define BS_CHANEL_DMA_SIZE (4*1024*1024) // BS用(32Mbps) |
0 | 81 |
82 typedef struct _DMA_CONTROL{ | |
83 dma_addr_t ring_dma[DMA_RING_MAX] ; // DMA情報 | |
84 __u32 *data[DMA_RING_MAX]; | |
85 }DMA_CONTROL; | |
86 | |
87 typedef struct _PT1_CHANNEL PT1_CHANNEL; | |
88 | |
89 typedef struct _pt1_device{ | |
90 unsigned long mmio_start ; | |
91 __u32 mmio_len ; | |
92 void __iomem *regs; | |
93 struct mutex lock ; | |
94 dma_addr_t ring_dma[DMA_RING_SIZE] ; // DMA情報 | |
95 void *dmaptr[DMA_RING_SIZE] ; | |
96 struct task_struct *kthread; | |
97 dev_t dev ; | |
31
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
98 int card_number; |
0 | 99 __u32 base_minor ; |
100 struct cdev cdev[MAX_CHANNEL]; | |
101 wait_queue_head_t dma_wait_q ;// for poll on reading | |
40
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
102 DMA_CONTROL *dmactl[DMA_RING_SIZE]; |
0 | 103 PT1_CHANNEL *channel[MAX_CHANNEL]; |
64
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
104 int cardtype; |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
105 } PT1_DEVICE; |
0 | 106 |
107 typedef struct _MICRO_PACKET{ | |
108 char data[3]; | |
109 char head ; | |
110 }MICRO_PACKET; | |
111 | |
112 struct _PT1_CHANNEL{ | |
113 __u32 valid ; // 使用中フラグ | |
114 __u32 address ; // I2Cアドレス | |
115 __u32 channel ; // チャネル番号 | |
37
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
116 int type ; // チャネルタイプ |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
117 __u32 packet_size ; // パケットサイズ |
0 | 118 __u32 drop ; // パケットドロップ数 |
119 struct mutex lock ; // CH別mutex_lock用 | |
120 __u32 size ; // DMAされたサイズ | |
121 __u32 maxsize ; // DMA用バッファサイズ | |
122 __u32 bufsize ; // チャネルに割り振られたサイズ | |
123 __u32 overflow ; // オーバーフローエラー発生 | |
124 __u32 counetererr ; // 転送カウンタ1エラー | |
125 __u32 transerr ; // 転送エラー | |
126 __u32 minor ; // マイナー番号 | |
127 __u8 *buf; // CH別受信メモリ | |
41
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
128 __u32 pointer; |
0 | 129 __u8 req_dma ; // 溢れたチャネル |
37
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
130 __u8 packet_buf[PACKET_SIZE] ; // 溢れたチャネル |
0 | 131 PT1_DEVICE *ptr ; // カード別情報 |
132 wait_queue_head_t wait_q ; // for poll on reading | |
133 }; | |
134 | |
135 // I2Cアドレス(video0, 1 = ISDB-S) (video2, 3 = ISDB-T) | |
136 int i2c_address[MAX_CHANNEL] = {T0_ISDB_S, T1_ISDB_S, T0_ISDB_T, T1_ISDB_T}; | |
86 | 137 int real_channel[MAX_CHANNEL] = {0, 2, 1, 3}; |
0 | 138 int channeltype[MAX_CHANNEL] = {CHANNEL_TYPE_ISDB_S, CHANNEL_TYPE_ISDB_S, |
139 CHANNEL_TYPE_ISDB_T, CHANNEL_TYPE_ISDB_T}; | |
140 | |
141 static PT1_DEVICE *device[MAX_PCI_DEVICE]; | |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
142 static struct class *pt1video_class; |
0 | 143 |
144 #define PT1MAJOR 251 | |
145 #define DRIVERNAME "pt1video" | |
146 | |
147 static void reset_dma(PT1_DEVICE *dev_conf) | |
148 { | |
149 | |
150 int lp ; | |
151 __u32 addr ; | |
152 int ring_pos = 0; | |
153 int data_pos = 0 ; | |
154 __u32 *dataptr ; | |
155 | |
156 // データ初期化 | |
157 for(ring_pos = 0 ; ring_pos < DMA_RING_SIZE ; ring_pos++){ | |
158 for(data_pos = 0 ; data_pos < DMA_RING_MAX ; data_pos++){ | |
40
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
159 dataptr = (dev_conf->dmactl[ring_pos])->data[data_pos]; |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
160 dataptr[(DMA_SIZE / sizeof(__u32)) - 2] = 0; |
0 | 161 } |
162 } | |
163 // 転送カウンタをリセット | |
164 writel(0x00000010, dev_conf->regs); | |
165 // 転送カウンタをインクリメント | |
166 for(lp = 0 ; lp < DMA_RING_SIZE ; lp++){ | |
167 writel(0x00000020, dev_conf->regs); | |
168 } | |
169 | |
170 addr = (int)dev_conf->ring_dma[0] ; | |
171 addr >>= 12 ; | |
172 // DMAバッファ設定 | |
173 writel(addr, dev_conf->regs + DMA_ADDR); | |
174 // DMA開始 | |
175 writel(0x0c000040, dev_conf->regs); | |
176 | |
177 } | |
178 static int pt1_thread(void *data) | |
179 { | |
180 PT1_DEVICE *dev_conf = data ; | |
181 PT1_CHANNEL *channel ; | |
182 int ring_pos = 0; | |
183 int data_pos = 0 ; | |
184 int lp ; | |
185 int chno ; | |
186 int lp2 ; | |
37
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
187 int dma_channel ; |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
188 int packet_pos ; |
0 | 189 __u32 *dataptr ; |
190 __u32 *curdataptr ; | |
191 __u32 val ; | |
192 union mpacket{ | |
193 __u32 val ; | |
194 MICRO_PACKET packet ; | |
195 }micro; | |
196 | |
197 set_freezable(); | |
198 reset_dma(dev_conf); | |
199 printk(KERN_INFO "pt1_thread run\n"); | |
200 | |
201 for(;;){ | |
202 if(kthread_should_stop()){ | |
203 break ; | |
204 } | |
205 | |
206 for(;;){ | |
40
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
207 dataptr = (dev_conf->dmactl[ring_pos])->data[data_pos]; |
0 | 208 // データあり? |
209 if(dataptr[(DMA_SIZE / sizeof(__u32)) - 2] == 0){ | |
210 break ; | |
211 } | |
212 micro.val = *dataptr ; | |
213 curdataptr = dataptr ; | |
214 data_pos += 1 ; | |
215 for(lp = 0 ; lp < (DMA_SIZE / sizeof(__u32)) ; lp++, dataptr++){ | |
216 micro.val = *dataptr ; | |
37
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
217 dma_channel = ((micro.packet.head >> 5) & 0x07); |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
218 //チャネル情報不正 |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
219 if(dma_channel > MAX_CHANNEL){ |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
220 printk(KERN_ERR "DMA Channel Number Error(%d)\n", dma_channel); |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
221 continue ; |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
222 } |
86 | 223 chno = real_channel[(((micro.packet.head >> 5) & 0x07) - 1)]; |
37
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
224 packet_pos = ((micro.packet.head >> 2) & 0x07); |
0 | 225 channel = dev_conf->channel[chno] ; |
226 // エラーチェック | |
227 if((micro.packet.head & MICROPACKET_ERROR)){ | |
228 val = readl(dev_conf->regs); | |
229 if((val & BIT_RAM_OVERFLOW)){ | |
230 channel->overflow += 1 ; | |
231 } | |
232 if((val & BIT_INITIATOR_ERROR)){ | |
233 channel->counetererr += 1 ; | |
234 } | |
235 if((val & BIT_INITIATOR_WARNING)){ | |
236 channel->transerr += 1 ; | |
237 } | |
238 // 初期化して先頭から | |
239 reset_dma(dev_conf); | |
240 ring_pos = data_pos = 0 ; | |
241 break ; | |
242 } | |
243 // 未使用チャネルは捨てる | |
244 if(channel->valid == FALSE){ | |
245 continue ; | |
246 } | |
247 mutex_lock(&channel->lock); | |
248 // あふれたら読み出すまで待つ | |
249 while(1){ | |
41
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
250 if(channel->size >= (channel->maxsize - PACKET_SIZE - 4)){ |
0 | 251 // 該当チャンネルのDMA読みだし待ちにする |
252 wake_up(&channel->wait_q); | |
253 channel->req_dma = TRUE ; | |
254 mutex_unlock(&channel->lock); | |
255 // タスクに時間を渡す為中断 | |
256 wait_event_timeout(dev_conf->dma_wait_q, (channel->req_dma == FALSE), | |
257 msecs_to_jiffies(500)); | |
258 mutex_lock(&channel->lock); | |
259 channel->drop += 1 ; | |
260 }else{ | |
261 break ; | |
262 } | |
263 } | |
37
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
264 // 先頭で、一時バッファに残っている場合 |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
265 if((micro.packet.head & 0x02) && (channel->packet_size != 0)){ |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
266 channel->packet_size = 0 ; |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
267 } |
0 | 268 // データコピー |
269 for(lp2 = 2 ; lp2 >= 0 ; lp2--){ | |
37
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
270 channel->packet_buf[channel->packet_size] = micro.packet.data[lp2] ; |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
271 channel->packet_size += 1 ; |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
272 } |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
273 |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
274 // パケットが出来たらコピーする |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
275 if(channel->packet_size >= PACKET_SIZE){ |
41
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
276 if (channel->pointer + channel->size >= channel->maxsize) { |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
277 // リングバッファの境界を越えていてリングバッファの先頭に戻っている場合 |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
278 // channel->pointer + channel->size - channel->maxsize でリングバッファ先頭からのアドレスになる |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
279 memcpy(&channel->buf[channel->pointer + channel->size - channel->maxsize], channel->packet_buf, PACKET_SIZE); |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
280 } else if (channel->pointer + channel->size + PACKET_SIZE > channel->maxsize) { |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
281 // リングバッファの境界をまたぐように書き込まれる場合 |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
282 // リングバッファの境界まで書き込み |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
283 __u32 tmp_size = channel->maxsize - (channel->pointer + channel->size); |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
284 memcpy(&channel->buf[channel->pointer + channel->size], channel->packet_buf, tmp_size); |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
285 // 先頭に戻って書き込み |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
286 memcpy(channel->buf, &channel->packet_buf[tmp_size], PACKET_SIZE - tmp_size); |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
287 } else { |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
288 // リングバッファ内で収まる場合 |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
289 // 通常の書き込み |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
290 memcpy(&channel->buf[channel->pointer + channel->size], channel->packet_buf, PACKET_SIZE); |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
291 } |
37
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
292 channel->size += PACKET_SIZE ; |
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
293 channel->packet_size = 0 ; |
0 | 294 } |
295 mutex_unlock(&channel->lock); | |
296 } | |
297 curdataptr[(DMA_SIZE / sizeof(__u32)) - 2] = 0; | |
298 | |
299 if(data_pos >= DMA_RING_MAX){ | |
300 data_pos = 0; | |
301 ring_pos += 1 ; | |
302 // DMAリングが変わった場合はインクリメント | |
303 writel(0x00000020, dev_conf->regs); | |
304 if(ring_pos >= DMA_RING_SIZE){ | |
305 ring_pos = 0 ; | |
306 } | |
307 } | |
308 | |
309 // 頻度を落す(4Kで起動させる) | |
310 for(lp = 0 ; lp < MAX_CHANNEL ; lp++){ | |
86 | 311 channel = dev_conf->channel[real_channel[lp]] ; |
0 | 312 if((channel->size >= DMA_SIZE) && (channel->valid == TRUE)){ |
313 wake_up(&channel->wait_q); | |
314 } | |
315 } | |
316 } | |
317 schedule_timeout_interruptible(msecs_to_jiffies(1)); | |
318 } | |
319 return 0 ; | |
320 } | |
321 static int pt1_open(struct inode *inode, struct file *file) | |
322 { | |
31
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
323 int major = imajor(inode); |
0 | 324 int minor = iminor(inode); |
325 int lp ; | |
326 int lp2 ; | |
327 PT1_CHANNEL *channel ; | |
328 | |
329 for(lp = 0 ; lp < MAX_PCI_DEVICE ; lp++){ | |
330 if(device[lp] == NULL){ | |
331 return -EIO ; | |
332 } | |
31
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
333 |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
334 if(MAJOR(device[lp]->dev) == major && |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
335 device[lp]->base_minor <= minor && |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
336 device[lp]->base_minor + MAX_CHANNEL > minor) { |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
337 |
0 | 338 mutex_lock(&device[lp]->lock); |
339 for(lp2 = 0 ; lp2 < MAX_CHANNEL ; lp2++){ | |
340 channel = device[lp]->channel[lp2] ; | |
341 if(channel->minor == minor){ | |
342 if(channel->valid == TRUE){ | |
343 mutex_unlock(&device[lp]->lock); | |
344 return -EIO ; | |
345 } | |
111
c8cfd684fee8
re-enable set_sleepmode. backing out r109.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
109
diff
changeset
|
346 |
102
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
347 /* wake tuner up */ |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
348 set_sleepmode(channel->ptr->regs, &channel->lock, |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
349 channel->address, channel->type, |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
350 TYPE_WAKEUP); |
108
bc173c443e4d
make sure that wait after set_sleepmode()
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
102
diff
changeset
|
351 schedule_timeout_interruptible(msecs_to_jiffies(50)); |
111
c8cfd684fee8
re-enable set_sleepmode. backing out r109.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
109
diff
changeset
|
352 |
0 | 353 channel->drop = 0 ; |
354 channel->valid = TRUE ; | |
355 channel->overflow = 0 ; | |
356 channel->counetererr = 0 ; | |
357 channel->transerr = 0 ; | |
37
c359e7adf700
propagate upstream change:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
36
diff
changeset
|
358 channel->packet_size = 0 ; |
0 | 359 file->private_data = channel; |
360 mutex_lock(&channel->lock); | |
361 // データ初期化 | |
362 channel->size = 0 ; | |
363 mutex_unlock(&channel->lock); | |
364 mutex_unlock(&device[lp]->lock); | |
365 return 0 ; | |
366 } | |
367 } | |
368 } | |
369 } | |
370 return -EIO; | |
371 } | |
372 static int pt1_release(struct inode *inode, struct file *file) | |
373 { | |
374 PT1_CHANNEL *channel = file->private_data; | |
375 | |
376 mutex_lock(&channel->ptr->lock); | |
377 SetStream(channel->ptr->regs, channel->channel, FALSE); | |
378 channel->valid = FALSE ; | |
31
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
379 printk(KERN_INFO "(%d:%d)Drop=%08d:%08d:%08d:%08d\n", imajor(inode), iminor(inode), channel->drop, |
0 | 380 channel->overflow, channel->counetererr, channel->transerr); |
381 channel->overflow = 0 ; | |
382 channel->counetererr = 0 ; | |
383 channel->transerr = 0 ; | |
384 channel->drop = 0 ; | |
385 // 停止している場合は起こす | |
386 if(channel->req_dma == TRUE){ | |
387 channel->req_dma = FALSE ; | |
388 wake_up(&channel->ptr->dma_wait_q); | |
389 } | |
390 mutex_unlock(&channel->ptr->lock); | |
102
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
391 |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
392 /* send tuner to sleep */ |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
393 set_sleepmode(channel->ptr->regs, &channel->lock, |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
394 channel->address, channel->type, TYPE_SLEEP); |
108
bc173c443e4d
make sure that wait after set_sleepmode()
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
102
diff
changeset
|
395 schedule_timeout_interruptible(msecs_to_jiffies(50)); |
102
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
396 |
0 | 397 return 0; |
398 } | |
399 | |
400 static ssize_t pt1_read(struct file *file, char __user *buf, size_t cnt, loff_t * ppos) | |
401 { | |
402 PT1_CHANNEL *channel = file->private_data; | |
403 __u32 size ; | |
36 | 404 unsigned long dummy; |
0 | 405 |
406 // 4K単位で起こされるのを待つ(CPU負荷対策) | |
407 if(channel->size < DMA_SIZE){ | |
408 wait_event_timeout(channel->wait_q, (channel->size >= DMA_SIZE), | |
409 msecs_to_jiffies(500)); | |
410 } | |
411 mutex_lock(&channel->lock); | |
412 if(!channel->size){ | |
413 size = 0 ; | |
414 }else{ | |
41
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
415 __u32 tmp_size = 0; |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
416 if (cnt < channel->size) { |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
417 // バッファにあるデータより小さい読み込みの場合 |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
418 size = cnt; |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
419 } else { |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
420 // バッファにあるデータ以上の読み込みの場合 |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
421 size = channel->size; |
0 | 422 } |
41
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
423 if (channel->maxsize <= size + channel->pointer) { |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
424 // リングバッファの境界を越える場合 |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
425 tmp_size = channel->maxsize - channel->pointer; |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
426 // 境界までコピー |
44 | 427 dummy = copy_to_user(buf, &channel->buf[channel->pointer], tmp_size); |
41
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
428 // 残りをコピー |
44 | 429 dummy = copy_to_user(&buf[tmp_size], channel->buf, size - tmp_size); |
41
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
430 channel->pointer = size - tmp_size; |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
431 } else { |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
432 // 普通にコピー |
44 | 433 dummy = copy_to_user(buf, &channel->buf[channel->pointer], size); |
41
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
434 channel->pointer += size; |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
435 } |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
436 channel->size -= size; |
0 | 437 } |
438 // 読み終わったかつ使用しているのがが4K以下 | |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
439 if(channel->req_dma == TRUE){ |
0 | 440 channel->req_dma = FALSE ; |
441 wake_up(&channel->ptr->dma_wait_q); | |
442 } | |
443 mutex_unlock(&channel->lock); | |
444 return size ; | |
445 } | |
446 static int SetFreq(PT1_CHANNEL *channel, FREQUENCY *freq) | |
447 { | |
448 | |
449 switch(channel->type){ | |
450 case CHANNEL_TYPE_ISDB_S: | |
451 { | |
452 ISDB_S_TMCC tmcc ; | |
453 if(bs_tune(channel->ptr->regs, | |
454 &channel->ptr->lock, | |
455 channel->address, | |
456 freq->frequencyno, | |
457 &tmcc) < 0){ | |
458 return -EIO ; | |
459 } | |
460 | |
461 #if 0 | |
462 printk(KERN_INFO "clockmargin = (%x)\n", (tmcc.clockmargin & 0xFF)); | |
463 printk(KERN_INFO "carriermargin = (%x)\n", (tmcc.carriermargin & 0xFF)); | |
102
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
464 { |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
465 int lp; |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
466 for(lp = 0 ; lp < MAX_BS_TS_ID ; lp++){ |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
467 if(tmcc.ts_id[lp].ts_id == 0xFFFF){ |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
468 continue ; |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
469 } |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
470 printk(KERN_INFO "Slot(%d:%x)\n", lp, tmcc.ts_id[lp].ts_id); |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
471 printk(KERN_INFO "mode (low/high) = (%x:%x)\n", |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
472 tmcc.ts_id[lp].low_mode, tmcc.ts_id[lp].high_mode); |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
473 printk(KERN_INFO "slot (low/high) = (%x:%x)\n", |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
474 tmcc.ts_id[lp].low_slot, |
6e661e828b43
send tuners to sleep mode when they are inactive
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
95
diff
changeset
|
475 tmcc.ts_id[lp].high_slot); |
0 | 476 } |
477 } | |
478 #endif | |
479 ts_lock(channel->ptr->regs, | |
480 &channel->ptr->lock, | |
481 channel->address, | |
482 tmcc.ts_id[freq->slot].ts_id); | |
483 } | |
484 break ; | |
485 case CHANNEL_TYPE_ISDB_T: | |
486 { | |
487 if(isdb_t_frequency(channel->ptr->regs, | |
488 &channel->ptr->lock, | |
489 channel->address, | |
490 freq->frequencyno, freq->slot) < 0){ | |
491 return -EINVAL ; | |
492 } | |
493 } | |
494 } | |
495 return 0 ; | |
496 } | |
95
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
497 |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
498 static int count_used_bs_tuners(PT1_DEVICE *device) |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
499 { |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
500 int count = 0; |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
501 int i; |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
502 |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
503 for(i=0; i<MAX_CHANNEL; i++) { |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
504 if(device && device->channel[i] && |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
505 device->channel[i]->type == CHANNEL_TYPE_ISDB_S && |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
506 device->channel[i]->valid) |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
507 count++; |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
508 } |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
509 |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
510 printk(KERN_INFO "used bs tuners on %p = %d\n", device, count); |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
511 return count; |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
512 } |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
513 |
36 | 514 static int pt1_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg0) |
0 | 515 { |
516 PT1_CHANNEL *channel = file->private_data; | |
95
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
517 int signal; |
36 | 518 unsigned long dummy; |
519 void *arg = (void *)arg0; | |
80
f336fd2dcf28
make LNB voltage can be specified from user application
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
79
diff
changeset
|
520 int lnb_eff, lnb_usr; |
f336fd2dcf28
make LNB voltage can be specified from user application
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
79
diff
changeset
|
521 char *voltage[] = {"0V", "11V", "15V"}; |
95
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
522 int count; |
0 | 523 |
524 switch(cmd){ | |
525 case SET_CHANNEL: | |
526 { | |
527 FREQUENCY freq ; | |
36 | 528 dummy = copy_from_user(&freq, arg, sizeof(FREQUENCY)); |
0 | 529 return SetFreq(channel, &freq); |
530 } | |
531 case START_REC: | |
532 SetStream(channel->ptr->regs, channel->channel, TRUE); | |
533 return 0 ; | |
534 case STOP_REC: | |
535 SetStream(channel->ptr->regs, channel->channel, FALSE); | |
536 return 0 ; | |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
537 case GET_SIGNAL_STRENGTH: |
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
538 switch(channel->type){ |
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
539 case CHANNEL_TYPE_ISDB_S: |
86 | 540 signal = isdb_s_read_signal_strength(channel->ptr->regs, |
541 &channel->ptr->lock, | |
542 channel->address); | |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
543 break ; |
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
544 case CHANNEL_TYPE_ISDB_T: |
36 | 545 signal = isdb_t_read_signal_strength(channel->ptr->regs, |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
546 &channel->ptr->lock, channel->address); |
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
547 break ; |
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
548 } |
36 | 549 dummy = copy_to_user(arg, &signal, sizeof(int)); |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
550 return 0 ; |
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
551 case LNB_ENABLE: |
95
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
552 count = count_used_bs_tuners(channel->ptr); |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
553 if(count <= 1) { |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
554 lnb_usr = (int)arg0; |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
555 lnb_eff = lnb_usr ? lnb_usr : lnb; |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
556 settuner_reset(channel->ptr->regs, channel->ptr->cardtype, lnb_eff, TUNER_POWER_ON_RESET_DISABLE); |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
557 printk(KERN_INFO "PT1:LNB on %s\n", voltage[lnb_eff]); |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
558 } |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
559 return 0 ; |
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
560 case LNB_DISABLE: |
95
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
561 count = count_used_bs_tuners(channel->ptr); |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
562 if(count <= 1) { |
82
cfb2da5ee428
added LNB reference count to maintain power state during recording.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
80
diff
changeset
|
563 settuner_reset(channel->ptr->regs, channel->ptr->cardtype, LNB_OFF, TUNER_POWER_ON_RESET_DISABLE); |
95
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
564 printk(KERN_INFO "PT1:LNB off\n"); |
a201531113ca
implement decent LNB management
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
93
diff
changeset
|
565 } |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
566 return 0 ; |
0 | 567 } |
568 return -EINVAL; | |
569 } | |
570 | |
571 /* | |
572 */ | |
573 static const struct file_operations pt1_fops = { | |
574 .owner = THIS_MODULE, | |
575 .open = pt1_open, | |
576 .release = pt1_release, | |
577 .read = pt1_read, | |
578 .ioctl = pt1_ioctl, | |
579 .llseek = no_llseek, | |
580 }; | |
581 | |
582 int pt1_makering(struct pci_dev *pdev, PT1_DEVICE *dev_conf) | |
583 { | |
584 int lp ; | |
585 int lp2 ; | |
586 DMA_CONTROL *dmactl; | |
587 __u32 *dmaptr ; | |
588 __u32 addr ; | |
589 __u32 *ptr ; | |
590 | |
591 //DMAリング作成 | |
592 for(lp = 0 ; lp < DMA_RING_SIZE ; lp++){ | |
593 ptr = dev_conf->dmaptr[lp]; | |
594 if(lp == (DMA_RING_SIZE - 1)){ | |
595 addr = (__u32)dev_conf->ring_dma[0]; | |
596 }else{ | |
597 addr = (__u32)dev_conf->ring_dma[(lp + 1)]; | |
598 } | |
599 addr >>= 12 ; | |
600 memcpy(ptr, &addr, sizeof(__u32)); | |
601 ptr += 1 ; | |
602 | |
40
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
603 dmactl = dev_conf->dmactl[lp]; |
0 | 604 for(lp2 = 0 ; lp2 < DMA_RING_MAX ; lp2++){ |
605 dmaptr = pci_alloc_consistent(pdev, DMA_SIZE, &dmactl->ring_dma[lp2]); | |
606 if(dmaptr == NULL){ | |
607 printk(KERN_INFO "PT1:DMA ALLOC ERROR\n"); | |
608 return -1 ; | |
609 } | |
610 dmactl->data[lp2] = dmaptr ; | |
611 // DMAデータエリア初期化 | |
612 dmaptr[(DMA_SIZE / sizeof(__u32)) - 2] = 0 ; | |
613 addr = (__u32)dmactl->ring_dma[lp2]; | |
614 addr >>= 12 ; | |
615 memcpy(ptr, &addr, sizeof(__u32)); | |
616 ptr += 1 ; | |
617 } | |
618 } | |
619 return 0 ; | |
620 } | |
621 int pt1_dma_init(struct pci_dev *pdev, PT1_DEVICE *dev_conf) | |
622 { | |
623 int lp ; | |
624 void *ptr ; | |
625 | |
626 for(lp = 0 ; lp < DMA_RING_SIZE ; lp++){ | |
627 ptr = pci_alloc_consistent(pdev, DMA_SIZE, &dev_conf->ring_dma[lp]); | |
628 if(ptr == NULL){ | |
629 printk(KERN_INFO "PT1:DMA ALLOC ERROR\n"); | |
630 return -1 ; | |
631 } | |
632 dev_conf->dmaptr[lp] = ptr ; | |
633 } | |
634 | |
635 return pt1_makering(pdev, dev_conf); | |
636 } | |
637 int pt1_dma_free(struct pci_dev *pdev, PT1_DEVICE *dev_conf) | |
638 { | |
639 | |
640 int lp ; | |
641 int lp2 ; | |
642 | |
643 for(lp = 0 ; lp < DMA_RING_SIZE ; lp++){ | |
644 if(dev_conf->dmaptr[lp] != NULL){ | |
645 pci_free_consistent(pdev, DMA_SIZE, | |
646 dev_conf->dmaptr[lp], dev_conf->ring_dma[lp]); | |
647 for(lp2 = 0 ; lp2 < DMA_RING_MAX ; lp2++){ | |
40
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
648 if((dev_conf->dmactl[lp])->data[lp2] != NULL){ |
0 | 649 pci_free_consistent(pdev, DMA_SIZE, |
40
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
650 (dev_conf->dmactl[lp])->data[lp2], |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
651 (dev_conf->dmactl[lp])->ring_dma[lp2]); |
0 | 652 } |
653 } | |
654 } | |
655 } | |
656 return 0 ; | |
657 } | |
658 static int __devinit pt1_pci_init_one (struct pci_dev *pdev, | |
659 const struct pci_device_id *ent) | |
660 { | |
661 int rc ; | |
662 int lp ; | |
663 int minor ; | |
664 u16 cmd ; | |
665 PT1_DEVICE *dev_conf ; | |
666 PT1_CHANNEL *channel ; | |
40
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
667 int i; |
36 | 668 struct resource *dummy; |
0 | 669 |
670 rc = pci_enable_device(pdev); | |
671 if (rc) | |
672 return rc; | |
64
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
673 rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(32)); |
0 | 674 if (rc) { |
675 printk(KERN_ERR "PT1:DMA MASK ERROR"); | |
676 return rc; | |
677 } | |
678 | |
679 pci_read_config_word(pdev, PCI_COMMAND, &cmd); | |
680 if (!(cmd & PCI_COMMAND_MASTER)) { | |
681 printk(KERN_INFO "Attempting to enable Bus Mastering\n"); | |
682 pci_set_master(pdev); | |
683 pci_read_config_word(pdev, PCI_COMMAND, &cmd); | |
684 if (!(cmd & PCI_COMMAND_MASTER)) { | |
685 printk(KERN_ERR "Bus Mastering is not enabled\n"); | |
686 return -EIO; | |
687 } | |
688 } | |
689 printk(KERN_INFO "Bus Mastering Enabled.\n"); | |
690 | |
691 dev_conf = kzalloc(sizeof(PT1_DEVICE), GFP_KERNEL); | |
692 if(!dev_conf){ | |
693 printk(KERN_ERR "PT1:out of memory !"); | |
694 return -ENOMEM ; | |
695 } | |
40
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
696 for (i = 0; i < DMA_RING_SIZE; i++) { |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
697 dev_conf->dmactl[i] = kzalloc(sizeof(DMA_CONTROL), GFP_KERNEL); |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
698 if(!dev_conf->dmactl[i]){ |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
699 int j; |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
700 for (j = 0; j < i; j++) { |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
701 kfree(dev_conf->dmactl[j]); |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
702 } |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
703 kfree(dev_conf); |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
704 printk(KERN_ERR "PT1:out of memory !"); |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
705 return -ENOMEM ; |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
706 } |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
707 } |
64
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
708 |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
709 switch(ent->device) { |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
710 case PCI_PT1_ID: |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
711 dev_conf->cardtype = PT1; |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
712 break; |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
713 case PCI_PT2_ID: |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
714 dev_conf->cardtype = PT2; |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
715 break; |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
716 default: |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
717 break; |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
718 } |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
719 |
0 | 720 // PCIアドレスをマップする |
721 dev_conf->mmio_start = pci_resource_start(pdev, 0); | |
722 dev_conf->mmio_len = pci_resource_len(pdev, 0); | |
36 | 723 dummy = request_mem_region(dev_conf->mmio_start, dev_conf->mmio_len, DEV_NAME); |
724 if (!dummy) { | |
79 | 725 printk(KERN_ERR "PT1:cannot request iomem (0x%llx).\n", (unsigned long long) dev_conf->mmio_start); |
0 | 726 goto out_err_regbase; |
727 } | |
728 | |
729 dev_conf->regs = ioremap(dev_conf->mmio_start, dev_conf->mmio_len); | |
730 if (!dev_conf->regs){ | |
79 | 731 printk(KERN_ERR "pt1:Can't remap register area.\n"); |
0 | 732 goto out_err_regbase; |
733 } | |
734 // 初期化処理 | |
79 | 735 if(xc3s_init(dev_conf->regs, dev_conf->cardtype)){ |
0 | 736 printk(KERN_ERR "Error xc3s_init\n"); |
737 goto out_err_fpga; | |
738 } | |
739 // チューナリセット | |
64
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
740 settuner_reset(dev_conf->regs, dev_conf->cardtype, LNB_OFF, TUNER_POWER_ON_RESET_ENABLE); |
0 | 741 schedule_timeout_interruptible(msecs_to_jiffies(50)); |
742 | |
64
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
743 settuner_reset(dev_conf->regs, dev_conf->cardtype, LNB_OFF, TUNER_POWER_ON_RESET_DISABLE); |
0 | 744 schedule_timeout_interruptible(msecs_to_jiffies(10)); |
745 mutex_init(&dev_conf->lock); | |
746 | |
747 // Tuner 初期化処理 | |
748 for(lp = 0 ; lp < MAX_TUNER ; lp++){ | |
69
272a8fba970b
added very rough support for PT2.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
64
diff
changeset
|
749 rc = tuner_init(dev_conf->regs, dev_conf->cardtype, &dev_conf->lock, lp); |
0 | 750 if(rc < 0){ |
751 printk(KERN_ERR "Error tuner_init\n"); | |
752 goto out_err_fpga; | |
753 } | |
754 } | |
755 // 初期化完了 | |
756 for(lp = 0 ; lp < MAX_CHANNEL ; lp++){ | |
36 | 757 set_sleepmode(dev_conf->regs, &dev_conf->lock, |
111
c8cfd684fee8
re-enable set_sleepmode. backing out r109.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
109
diff
changeset
|
758 i2c_address[lp], channeltype[lp], TYPE_SLEEP); |
36 | 759 |
0 | 760 schedule_timeout_interruptible(msecs_to_jiffies(50)); |
761 } | |
762 rc = alloc_chrdev_region(&dev_conf->dev, 0, MAX_CHANNEL, DEV_NAME); | |
763 if(rc < 0){ | |
764 goto out_err_fpga; | |
765 } | |
766 | |
767 // 初期化 | |
768 init_waitqueue_head(&dev_conf->dma_wait_q); | |
769 | |
770 minor = MINOR(dev_conf->dev) ; | |
771 dev_conf->base_minor = minor ; | |
772 for(lp = 0 ; lp < MAX_PCI_DEVICE ; lp++){ | |
79 | 773 printk(KERN_INFO "PT1:device[%d]=%p\n", lp, device[lp]); |
0 | 774 if(device[lp] == NULL){ |
775 device[lp] = dev_conf ; | |
31
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
776 dev_conf->card_number = lp; |
0 | 777 break ; |
778 } | |
779 } | |
780 for(lp = 0 ; lp < MAX_CHANNEL ; lp++){ | |
781 cdev_init(&dev_conf->cdev[lp], &pt1_fops); | |
30
eb694d8e4c7e
setup owner in initialization
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
9
diff
changeset
|
782 dev_conf->cdev[lp].owner = THIS_MODULE; |
31
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
783 cdev_add(&dev_conf->cdev[lp], |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
784 MKDEV(MAJOR(dev_conf->dev), (MINOR(dev_conf->dev) + lp)), 1); |
0 | 785 channel = kzalloc(sizeof(PT1_CHANNEL), GFP_KERNEL); |
786 if(!channel){ | |
787 printk(KERN_ERR "PT1:out of memory !"); | |
788 return -ENOMEM ; | |
789 } | |
790 | |
791 // 共通情報 | |
792 mutex_init(&channel->lock); | |
793 // 待ち状態を解除 | |
794 channel->req_dma = FALSE ; | |
795 // マイナー番号設定 | |
796 channel->minor = MINOR(dev_conf->dev) + lp ; | |
797 // 対象のI2Cデバイス | |
798 channel->address = i2c_address[lp] ; | |
799 channel->type = channeltype[lp] ; | |
800 // 実際のチューナ番号 | |
86 | 801 channel->channel = real_channel[lp] ; |
0 | 802 channel->ptr = dev_conf ; |
803 channel->size = 0 ; | |
804 dev_conf->channel[lp] = channel ; | |
805 | |
806 init_waitqueue_head(&channel->wait_q); | |
807 | |
808 switch(channel->type){ | |
809 case CHANNEL_TYPE_ISDB_T: | |
810 channel->maxsize = CHANEL_DMA_SIZE ; | |
41
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
811 channel->buf = vmalloc(CHANEL_DMA_SIZE); |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
812 channel->pointer = 0; |
0 | 813 break ; |
814 case CHANNEL_TYPE_ISDB_S: | |
815 channel->maxsize = BS_CHANEL_DMA_SIZE ; | |
41
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
816 channel->buf = vmalloc(BS_CHANEL_DMA_SIZE); |
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
817 channel->pointer = 0; |
0 | 818 break ; |
819 } | |
820 if(channel->buf == NULL){ | |
821 goto out_err_v4l; | |
822 } | |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
823 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27) |
79 | 824 printk(KERN_INFO "PT1:card_number = %d\n", |
31
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
825 dev_conf->card_number); |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
826 device_create(pt1video_class, |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
827 NULL, |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
828 MKDEV(MAJOR(dev_conf->dev), |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
829 (MINOR(dev_conf->dev) + lp)), |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
830 NULL, |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
831 "pt1video%u", |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
832 MINOR(dev_conf->dev) + lp + |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
833 dev_conf->card_number * MAX_CHANNEL); |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
834 #else |
31
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
835 device_create(pt1video_class, |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
836 NULL, |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
837 MKDEV(MAJOR(dev_conf->dev), |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
838 (MINOR(dev_conf->dev) + lp)), |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
839 "pt1video%u", |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
840 MINOR(dev_conf->dev) + lp + |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
841 dev_conf->card_number * MAX_CHANNEL); |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
842 #endif |
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
843 |
0 | 844 #if 0 |
845 dev_conf->vdev[lp] = video_device_alloc(); | |
846 memcpy(dev_conf->vdev[lp], &pt1_template, sizeof(pt1_template)); | |
847 video_set_drvdata(dev_conf->vdev[lp], channel); | |
848 video_register_device(dev_conf->vdev[lp], VFL_TYPE_GRABBER, -1); | |
849 #endif | |
850 } | |
31
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
851 |
0 | 852 if(pt1_dma_init(pdev, dev_conf) < 0){ |
853 goto out_err_dma; | |
854 } | |
855 dev_conf->kthread = kthread_run(pt1_thread, dev_conf, "pt1"); | |
856 pci_set_drvdata(pdev, dev_conf); | |
857 return 0; | |
858 | |
859 out_err_dma: | |
860 pt1_dma_free(pdev, dev_conf); | |
861 out_err_v4l: | |
862 for(lp = 0 ; lp < MAX_CHANNEL ; lp++){ | |
863 if(dev_conf->channel[lp] != NULL){ | |
864 if(dev_conf->channel[lp]->buf != NULL){ | |
41
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
865 vfree(dev_conf->channel[lp]->buf); |
0 | 866 } |
867 kfree(dev_conf->channel[lp]); | |
868 } | |
869 } | |
870 out_err_fpga: | |
871 writel(0xb0b0000, dev_conf->regs); | |
64
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
872 writel(0, dev_conf->regs + CFG_REGS_ADDR); |
0 | 873 iounmap(dev_conf->regs); |
874 release_mem_region(dev_conf->mmio_start, dev_conf->mmio_len); | |
40
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
875 for (i = 0; i < DMA_RING_SIZE; i++) { |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
876 kfree(dev_conf->dmactl[i]); |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
877 } |
0 | 878 kfree(dev_conf); |
879 out_err_regbase: | |
880 return -EIO; | |
881 | |
882 } | |
883 | |
884 static void __devexit pt1_pci_remove_one(struct pci_dev *pdev) | |
885 { | |
886 | |
887 int lp ; | |
888 __u32 val ; | |
889 PT1_DEVICE *dev_conf = (PT1_DEVICE *)pci_get_drvdata(pdev); | |
40
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
890 int i; |
0 | 891 |
892 if(dev_conf){ | |
893 if(dev_conf->kthread) { | |
894 kthread_stop(dev_conf->kthread); | |
895 dev_conf->kthread = NULL; | |
896 } | |
897 | |
898 // DMA終了 | |
899 writel(0x08080000, dev_conf->regs); | |
900 for(lp = 0 ; lp < 10 ; lp++){ | |
901 val = readl(dev_conf->regs); | |
902 if(!(val & (1 << 6))){ | |
903 break ; | |
904 } | |
905 schedule_timeout_interruptible(msecs_to_jiffies(1)); | |
906 } | |
907 pt1_dma_free(pdev, dev_conf); | |
908 for(lp = 0 ; lp < MAX_CHANNEL ; lp++){ | |
909 if(dev_conf->channel[lp] != NULL){ | |
910 cdev_del(&dev_conf->cdev[lp]); | |
41
51a006a8d843
imported patch ringbuf-vmalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
40
diff
changeset
|
911 vfree(dev_conf->channel[lp]->buf); |
0 | 912 kfree(dev_conf->channel[lp]); |
913 } | |
31
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
914 device_destroy(pt1video_class, |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
915 MKDEV(MAJOR(dev_conf->dev), |
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
916 (MINOR(dev_conf->dev) + lp))); |
0 | 917 } |
31
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
918 |
0 | 919 unregister_chrdev_region(dev_conf->dev, MAX_CHANNEL); |
920 writel(0xb0b0000, dev_conf->regs); | |
64
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
921 writel(0, dev_conf->regs + CFG_REGS_ADDR); |
98a92ce5382e
added fake support code for PT2. the PT2 part is not expected to work. be careful!
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
51
diff
changeset
|
922 settuner_reset(dev_conf->regs, dev_conf->cardtype, LNB_OFF, TUNER_POWER_OFF); |
0 | 923 release_mem_region(dev_conf->mmio_start, dev_conf->mmio_len); |
924 iounmap(dev_conf->regs); | |
40
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
925 for (i = 0; i < DMA_RING_SIZE; i++) { |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
926 kfree(dev_conf->dmactl[i]); |
8f30a05cded2
imported patch dmactlalloc
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
37
diff
changeset
|
927 } |
31
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
928 device[dev_conf->card_number] = NULL; |
0 | 929 kfree(dev_conf); |
930 } | |
931 pci_set_drvdata(pdev, NULL); | |
932 } | |
933 #ifdef CONFIG_PM | |
934 | |
935 static int pt1_pci_suspend (struct pci_dev *pdev, pm_message_t state) | |
936 { | |
937 return 0; | |
938 } | |
939 | |
940 static int pt1_pci_resume (struct pci_dev *pdev) | |
941 { | |
942 return 0; | |
943 } | |
944 | |
945 #endif /* CONFIG_PM */ | |
946 | |
947 | |
948 static struct pci_driver pt1_driver = { | |
949 .name = DRV_NAME, | |
950 .probe = pt1_pci_init_one, | |
951 .remove = __devexit_p(pt1_pci_remove_one), | |
952 .id_table = pt1_pci_tbl, | |
953 #ifdef CONFIG_PM | |
954 .suspend = pt1_pci_suspend, | |
955 .resume = pt1_pci_resume, | |
956 #endif /* CONFIG_PM */ | |
957 | |
958 }; | |
959 | |
960 | |
961 static int __init pt1_pci_init(void) | |
962 { | |
93 | 963 printk(KERN_INFO "%s", version); |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
964 pt1video_class = class_create(THIS_MODULE, DRIVERNAME); |
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
965 if (IS_ERR(pt1video_class)) |
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
966 return PTR_ERR(pt1video_class); |
0 | 967 return pci_register_driver(&pt1_driver); |
968 } | |
969 | |
970 | |
971 static void __exit pt1_pci_cleanup(void) | |
972 { | |
9
07b2fc07ff48
updated to current driver to support signal strength.
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
0
diff
changeset
|
973 class_destroy(pt1video_class); |
31
289794dc265f
adapted to use of multiple number of pt1:
Yoshiki Yazawa <yaz@honeyplanet.jp>
parents:
30
diff
changeset
|
974 pci_unregister_driver(&pt1_driver); |
0 | 975 } |
976 | |
977 module_init(pt1_pci_init); | |
978 module_exit(pt1_pci_cleanup); |