?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
fs: use kmem_cache_zalloc instead
[pv_ops_mirror.git] / drivers / net / irda / via-ircc.c
blob126ec7c8680ea176a156be4c4aca2cc16bcb66f5
1 /********************************************************************
2 Filename: via-ircc.c
3 Version: 1.0
4 Description: Driver for the VIA VT8231/VT8233 IrDA chipsets
5 Author: VIA Technologies,inc
6 Date : 08/06/2003
7
8 Copyright (c) 1998-2003 VIA Technologies, Inc.
9
10 This program is free software; you can redistribute it and/or modify it under
11 the terms of the GNU General Public License as published by the Free Software
12 Foundation; either version 2, or (at your option) any later version.
13
14 This program is distributed in the hope that it will be useful, but WITHOUT
15 ANY WARRANTIES OR REPRESENTATIONS; without even the implied warranty of
16 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
17 See the GNU General Public License for more details.
18
19 You should have received a copy of the GNU General Public License along with
20 this program; if not, write to the Free Software Foundation, Inc.,
21 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
22
23 F01 Oct/02/02: Modify code for V0.11(move out back to back transfer)
24 F02 Oct/28/02: Add SB device ID for 3147 and 3177.
25 Comment :
26 jul/09/2002 : only implement two kind of dongle currently.
27 Oct/02/2002 : work on VT8231 and VT8233 .
28 Aug/06/2003 : change driver format to pci driver .
29
30 2004-02-16: <sda@bdit.de>
31 - Removed unneeded 'legacy' pci stuff.
32 - Make sure SIR mode is set (hw_init()) before calling mode-dependant stuff.
33 - On speed change from core, don't send SIR frame with new speed.
34 Use current speed and change speeds later.
35 - Make module-param dongle_id actually work.
36 - New dongle_id 17 (0x11): TDFS4500. Single-ended SIR only.
37 Tested with home-grown PCB on EPIA boards.
38 - Code cleanup.
39
40 ********************************************************************/
41 #include <linux/module.h>
42 #include <linux/kernel.h>
43 #include <linux/types.h>
44 #include <linux/skbuff.h>
45 #include <linux/netdevice.h>
46 #include <linux/ioport.h>
47 #include <linux/delay.h>
48 #include <linux/slab.h>
49 #include <linux/init.h>
50 #include <linux/rtnetlink.h>
51 #include <linux/pci.h>
52 #include <linux/dma-mapping.h>
53
54 #include <asm/io.h>
55 #include <asm/dma.h>
56 #include <asm/byteorder.h>
57
58 #include <linux/pm.h>
59
60 #include <net/irda/wrapper.h>
61 #include <net/irda/irda.h>
62 #include <net/irda/irda_device.h>
63
64 #include "via-ircc.h"
65
66 #define VIA_MODULE_NAME "via-ircc"
67 #define CHIP_IO_EXTENT 0x40
68
69 static char *driver_name = VIA_MODULE_NAME;
70
71 /* Module parameters */
72 static int qos_mtt_bits = 0x07; /* 1 ms or more */
73 static int dongle_id = 0; /* default: probe */
74
75 /* We can't guess the type of connected dongle, user *must* supply it. */
76 module_param(dongle_id, int, 0);
77
78 /* FIXME : we should not need this, because instances should be automatically
79 * managed by the PCI layer. Especially that we seem to only be using the
80 * first entry. Jean II */
81 /* Max 4 instances for now */
82 static struct via_ircc_cb *dev_self[] = { NULL, NULL, NULL, NULL };
83
84 /* Some prototypes */
85 static int via_ircc_open(int i, chipio_t * info, unsigned int id);
86 static int via_ircc_close(struct via_ircc_cb *self);
87 static int via_ircc_dma_receive(struct via_ircc_cb *self);
88 static int via_ircc_dma_receive_complete(struct via_ircc_cb *self,
89 int iobase);
90 static int via_ircc_hard_xmit_sir(struct sk_buff *skb,
91 struct net_device *dev);
92 static int via_ircc_hard_xmit_fir(struct sk_buff *skb,
93 struct net_device *dev);
94 static void via_hw_init(struct via_ircc_cb *self);
95 static void via_ircc_change_speed(struct via_ircc_cb *self, __u32 baud);
96 static irqreturn_t via_ircc_interrupt(int irq, void *dev_id);
97 static int via_ircc_is_receiving(struct via_ircc_cb *self);
98 static int via_ircc_read_dongle_id(int iobase);
99
100 static int via_ircc_net_open(struct net_device *dev);
101 static int via_ircc_net_close(struct net_device *dev);
102 static int via_ircc_net_ioctl(struct net_device *dev, struct ifreq *rq,
103 int cmd);
104 static struct net_device_stats *via_ircc_net_get_stats(struct net_device
105 *dev);
106 static void via_ircc_change_dongle_speed(int iobase, int speed,
107 int dongle_id);
108 static int RxTimerHandler(struct via_ircc_cb *self, int iobase);
109 static void hwreset(struct via_ircc_cb *self);
110 static int via_ircc_dma_xmit(struct via_ircc_cb *self, u16 iobase);
111 static int upload_rxdata(struct via_ircc_cb *self, int iobase);
112 static int __devinit via_init_one (struct pci_dev *pcidev, const struct pci_device_id *id);
113 static void __devexit via_remove_one (struct pci_dev *pdev);
114
115 /* FIXME : Should use udelay() instead, even if we are x86 only - Jean II */
116 static void iodelay(int udelay)
117 {
118 u8 data;
119 int i;
120
121 for (i = 0; i < udelay; i++) {
122 data = inb(0x80);
123 }
124 }
125
126 static struct pci_device_id via_pci_tbl[] = {
127 { PCI_VENDOR_ID_VIA, 0x8231, PCI_ANY_ID, PCI_ANY_ID,0,0,0 },
128 { PCI_VENDOR_ID_VIA, 0x3109, PCI_ANY_ID, PCI_ANY_ID,0,0,1 },
129 { PCI_VENDOR_ID_VIA, 0x3074, PCI_ANY_ID, PCI_ANY_ID,0,0,2 },
130 { PCI_VENDOR_ID_VIA, 0x3147, PCI_ANY_ID, PCI_ANY_ID,0,0,3 },
131 { PCI_VENDOR_ID_VIA, 0x3177, PCI_ANY_ID, PCI_ANY_ID,0,0,4 },
132 { 0, }
133 };
134
135 MODULE_DEVICE_TABLE(pci,via_pci_tbl);
136
137
138 static struct pci_driver via_driver = {
139 .name = VIA_MODULE_NAME,
140 .id_table = via_pci_tbl,
141 .probe = via_init_one,
142 .remove = __devexit_p(via_remove_one),
143 };
144
145
146 /*
147 * Function via_ircc_init ()
148 *
149 * Initialize chip. Just find out chip type and resource.
150 */
151 static int __init via_ircc_init(void)
152 {
153 int rc;
154
155 IRDA_DEBUG(3, "%s()\n", __FUNCTION__);
156
157 rc = pci_register_driver(&via_driver);
158 if (rc < 0) {
159 IRDA_DEBUG(0, "%s(): error rc = %d, returning -ENODEV...\n",
160 __FUNCTION__, rc);
161 return -ENODEV;
162 }
163 return 0;
164 }
165
166 static int __devinit via_init_one (struct pci_dev *pcidev, const struct pci_device_id *id)
167 {
168 int rc;
169 u8 temp,oldPCI_40,oldPCI_44,bTmp,bTmp1;
170 u16 Chipset,FirDRQ1,FirDRQ0,FirIRQ,FirIOBase;
171 chipio_t info;
172
173 IRDA_DEBUG(2, "%s(): Device ID=(0X%X)\n", __FUNCTION__, id->device);
174
175 rc = pci_enable_device (pcidev);
176 if (rc) {
177 IRDA_DEBUG(0, "%s(): error rc = %d\n", __FUNCTION__, rc);
178 return -ENODEV;
179 }
180
181 // South Bridge exist
182 if ( ReadLPCReg(0x20) != 0x3C )
183 Chipset=0x3096;
184 else
185 Chipset=0x3076;
186
187 if (Chipset==0x3076) {
188 IRDA_DEBUG(2, "%s(): Chipset = 3076\n", __FUNCTION__);
189
190 WriteLPCReg(7,0x0c );
191 temp=ReadLPCReg(0x30);//check if BIOS Enable Fir
192 if((temp&0x01)==1) { // BIOS close or no FIR
193 WriteLPCReg(0x1d, 0x82 );
194 WriteLPCReg(0x23,0x18);
195 temp=ReadLPCReg(0xF0);
196 if((temp&0x01)==0) {
197 temp=(ReadLPCReg(0x74)&0x03); //DMA
198 FirDRQ0=temp + 4;
199 temp=(ReadLPCReg(0x74)&0x0C) >> 2;
200 FirDRQ1=temp + 4;
201 } else {
202 temp=(ReadLPCReg(0x74)&0x0C) >> 2; //DMA
203 FirDRQ0=temp + 4;
204 FirDRQ1=FirDRQ0;
205 }
206 FirIRQ=(ReadLPCReg(0x70)&0x0f); //IRQ
207 FirIOBase=ReadLPCReg(0x60 ) << 8; //IO Space :high byte
208 FirIOBase=FirIOBase| ReadLPCReg(0x61) ; //low byte
209 FirIOBase=FirIOBase ;
210 info.fir_base=FirIOBase;
211 info.irq=FirIRQ;
212 info.dma=FirDRQ1;
213 info.dma2=FirDRQ0;
214 pci_read_config_byte(pcidev,0x40,&bTmp);
215 pci_write_config_byte(pcidev,0x40,((bTmp | 0x08) & 0xfe));
216 pci_read_config_byte(pcidev,0x42,&bTmp);
217 pci_write_config_byte(pcidev,0x42,(bTmp | 0xf0));
218 pci_write_config_byte(pcidev,0x5a,0xc0);
219 WriteLPCReg(0x28, 0x70 );
220 if (via_ircc_open(0, &info,0x3076) == 0)
221 rc=0;
222 } else
223 rc = -ENODEV; //IR not turn on
224 } else { //Not VT1211
225 IRDA_DEBUG(2, "%s(): Chipset = 3096\n", __FUNCTION__);
226
227 pci_read_config_byte(pcidev,0x67,&bTmp);//check if BIOS Enable Fir
228 if((bTmp&0x01)==1) { // BIOS enable FIR
229 //Enable Double DMA clock
230 pci_read_config_byte(pcidev,0x42,&oldPCI_40);
231 pci_write_config_byte(pcidev,0x42,oldPCI_40 | 0x80);
232 pci_read_config_byte(pcidev,0x40,&oldPCI_40);
233 pci_write_config_byte(pcidev,0x40,oldPCI_40 & 0xf7);
234 pci_read_config_byte(pcidev,0x44,&oldPCI_44);
235 pci_write_config_byte(pcidev,0x44,0x4e);
236 //---------- read configuration from Function0 of south bridge
237 if((bTmp&0x02)==0) {
238 pci_read_config_byte(pcidev,0x44,&bTmp1); //DMA
239 FirDRQ0 = (bTmp1 & 0x30) >> 4;
240 pci_read_config_byte(pcidev,0x44,&bTmp1);
241 FirDRQ1 = (bTmp1 & 0xc0) >> 6;
242 } else {
243 pci_read_config_byte(pcidev,0x44,&bTmp1); //DMA
244 FirDRQ0 = (bTmp1 & 0x30) >> 4 ;
245 FirDRQ1=0;
246 }
247 pci_read_config_byte(pcidev,0x47,&bTmp1); //IRQ
248 FirIRQ = bTmp1 & 0x0f;
249
250 pci_read_config_byte(pcidev,0x69,&bTmp);
251 FirIOBase = bTmp << 8;//hight byte
252 pci_read_config_byte(pcidev,0x68,&bTmp);
253 FirIOBase = (FirIOBase | bTmp ) & 0xfff0;
254 //-------------------------
255 info.fir_base=FirIOBase;
256 info.irq=FirIRQ;
257 info.dma=FirDRQ1;
258 info.dma2=FirDRQ0;
259 if (via_ircc_open(0, &info,0x3096) == 0)
260 rc=0;
261 } else
262 rc = -ENODEV; //IR not turn on !!!!!
263 }//Not VT1211
264
265 IRDA_DEBUG(2, "%s(): End - rc = %d\n", __FUNCTION__, rc);
266 return rc;
267 }
268
269 /*
270 * Function via_ircc_clean ()
271 *
272 * Close all configured chips
273 *
274 */
275 static void via_ircc_clean(void)
276 {
277 int i;
278
279 IRDA_DEBUG(3, "%s()\n", __FUNCTION__);
280
281 for (i=0; i < ARRAY_SIZE(dev_self); i++) {
282 if (dev_self[i])
283 via_ircc_close(dev_self[i]);
284 }
285 }
286
287 static void __devexit via_remove_one (struct pci_dev *pdev)
288 {
289 IRDA_DEBUG(3, "%s()\n", __FUNCTION__);
290
291 /* FIXME : This is ugly. We should use pci_get_drvdata(pdev);
292 * to get our driver instance and call directly via_ircc_close().
293 * See vlsi_ir for details...
294 * Jean II */
295 via_ircc_clean();
296
297 /* FIXME : This should be in via_ircc_close(), because here we may
298 * theoritically disable still configured devices :-( - Jean II */
299 pci_disable_device(pdev);
300 }
301
302 static void __exit via_ircc_cleanup(void)
303 {
304 IRDA_DEBUG(3, "%s()\n", __FUNCTION__);
305
306 /* FIXME : This should be redundant, as pci_unregister_driver()
307 * should call via_remove_one() on each device.
308 * Jean II */
309 via_ircc_clean();
310
311 /* Cleanup all instances of the driver */
312 pci_unregister_driver (&via_driver);
313 }
314
315 /*
316 * Function via_ircc_open (iobase, irq)
317 *
318 * Open driver instance
319 *
320 */
321 static __devinit int via_ircc_open(int i, chipio_t * info, unsigned int id)
322 {
323 struct net_device *dev;
324 struct via_ircc_cb *self;
325 int err;
326
327 IRDA_DEBUG(3, "%s()\n", __FUNCTION__);
328
329 if (i >= ARRAY_SIZE(dev_self))
330 return -ENOMEM;
331
332 /* Allocate new instance of the driver */
333 dev = alloc_irdadev(sizeof(struct via_ircc_cb));
334 if (dev == NULL)
335 return -ENOMEM;
336
337 self = dev->priv;
338 self->netdev = dev;
339 spin_lock_init(&self->lock);
340
341 /* FIXME : We should store our driver instance in the PCI layer,
342 * using pci_set_drvdata(), not in this array.
343 * See vlsi_ir for details... - Jean II */
344 /* FIXME : 'i' is always 0 (see via_init_one()) :-( - Jean II */
345 /* Need to store self somewhere */
346 dev_self[i] = self;
347 self->index = i;
348 /* Initialize Resource */
349 self->io.cfg_base = info->cfg_base;
350 self->io.fir_base = info->fir_base;
351 self->io.irq = info->irq;
352 self->io.fir_ext = CHIP_IO_EXTENT;
353 self->io.dma = info->dma;
354 self->io.dma2 = info->dma2;
355 self->io.fifo_size = 32;
356 self->chip_id = id;
357 self->st_fifo.len = 0;
358 self->RxDataReady = 0;
359
360 /* Reserve the ioports that we need */
361 if (!request_region(self->io.fir_base, self->io.fir_ext, driver_name)) {
362 IRDA_DEBUG(0, "%s(), can't get iobase of 0x%03x\n",
363 __FUNCTION__, self->io.fir_base);
364 err = -ENODEV;
365 goto err_out1;
366 }
367
368 /* Initialize QoS for this device */
369 irda_init_max_qos_capabilies(&self->qos);
370
371 /* Check if user has supplied the dongle id or not */
372 if (!dongle_id)
373 dongle_id = via_ircc_read_dongle_id(self->io.fir_base);
374 self->io.dongle_id = dongle_id;
375
376 /* The only value we must override it the baudrate */
377 /* Maximum speeds and capabilities are dongle-dependant. */
378 switch( self->io.dongle_id ){
379 case 0x0d:
380 self->qos.baud_rate.bits =
381 IR_9600 | IR_19200 | IR_38400 | IR_57600 | IR_115200 |
382 IR_576000 | IR_1152000 | (IR_4000000 << 8);
383 break;
384 default:
385 self->qos.baud_rate.bits =
386 IR_9600 | IR_19200 | IR_38400 | IR_57600 | IR_115200;
387 break;
388 }
389
390 /* Following was used for testing:
391 *
392 * self->qos.baud_rate.bits = IR_9600;
393 *
394 * Is is no good, as it prohibits (error-prone) speed-changes.
395 */
396
397 self->qos.min_turn_time.bits = qos_mtt_bits;
398 irda_qos_bits_to_value(&self->qos);
399
400 /* Max DMA buffer size needed = (data_size + 6) * (window_size) + 6; */
401 self->rx_buff.truesize = 14384 + 2048;
402 self->tx_buff.truesize = 14384 + 2048;
403
404 /* Allocate memory if needed */
405 self->rx_buff.head =
406 dma_alloc_coherent(NULL, self->rx_buff.truesize,
407 &self->rx_buff_dma, GFP_KERNEL);
408 if (self->rx_buff.head == NULL) {
409 err = -ENOMEM;
410 goto err_out2;
411 }
412 memset(self->rx_buff.head, 0, self->rx_buff.truesize);
413
414 self->tx_buff.head =
415 dma_alloc_coherent(NULL, self->tx_buff.truesize,
416 &self->tx_buff_dma, GFP_KERNEL);
417 if (self->tx_buff.head == NULL) {
418 err = -ENOMEM;
419 goto err_out3;
420 }
421 memset(self->tx_buff.head, 0, self->tx_buff.truesize);
422
423 self->rx_buff.in_frame = FALSE;
424 self->rx_buff.state = OUTSIDE_FRAME;
425 self->tx_buff.data = self->tx_buff.head;
426 self->rx_buff.data = self->rx_buff.head;
427
428 /* Reset Tx queue info */
429 self->tx_fifo.len = self->tx_fifo.ptr = self->tx_fifo.free = 0;
430 self->tx_fifo.tail = self->tx_buff.head;
431
432 /* Override the network functions we need to use */
433 dev->hard_start_xmit = via_ircc_hard_xmit_sir;
434 dev->open = via_ircc_net_open;
435 dev->stop = via_ircc_net_close;
436 dev->do_ioctl = via_ircc_net_ioctl;
437 dev->get_stats = via_ircc_net_get_stats;
438
439 err = register_netdev(dev);
440 if (err)
441 goto err_out4;
442
443 IRDA_MESSAGE("IrDA: Registered device %s (via-ircc)\n", dev->name);
444
445 /* Initialise the hardware..
446 */
447 self->io.speed = 9600;
448 via_hw_init(self);
449 return 0;
450 err_out4:
451 dma_free_coherent(NULL, self->tx_buff.truesize,
452 self->tx_buff.head, self->tx_buff_dma);
453 err_out3:
454 dma_free_coherent(NULL, self->rx_buff.truesize,
455 self->rx_buff.head, self->rx_buff_dma);
456 err_out2:
457 release_region(self->io.fir_base, self->io.fir_ext);
458 err_out1:
459 free_netdev(dev);
460 dev_self[i] = NULL;
461 return err;
462 }
463
464 /*
465 * Function via_ircc_close (self)
466 *
467 * Close driver instance
468 *
469 */
470 static int via_ircc_close(struct via_ircc_cb *self)
471 {
472 int iobase;
473
474 IRDA_DEBUG(3, "%s()\n", __FUNCTION__);
475
476 IRDA_ASSERT(self != NULL, return -1;);
477
478 iobase = self->io.fir_base;
479
480 ResetChip(iobase, 5); //hardware reset.
481 /* Remove netdevice */
482 unregister_netdev(self->netdev);
483
484 /* Release the PORT that this driver is using */
485 IRDA_DEBUG(2, "%s(), Releasing Region %03x\n",
486 __FUNCTION__, self->io.fir_base);
487 release_region(self->io.fir_base, self->io.fir_ext);
488 if (self->tx_buff.head)
489 dma_free_coherent(NULL, self->tx_buff.truesize,
490 self->tx_buff.head, self->tx_buff_dma);
491 if (self->rx_buff.head)
492 dma_free_coherent(NULL, self->rx_buff.truesize,
493 self->rx_buff.head, self->rx_buff_dma);
494 dev_self[self->index] = NULL;
495
496 free_netdev(self->netdev);
497
498 return 0;
499 }
500
501 /*
502 * Function via_hw_init(self)
503 *
504 * Returns non-negative on success.
505 *
506 * Formerly via_ircc_setup
507 */
508 static void via_hw_init(struct via_ircc_cb *self)
509 {
510 int iobase = self->io.fir_base;
511
512 IRDA_DEBUG(3, "%s()\n", __FUNCTION__);
513
514 SetMaxRxPacketSize(iobase, 0x0fff); //set to max:4095
515 // FIFO Init
516 EnRXFIFOReadyInt(iobase, OFF);
517 EnRXFIFOHalfLevelInt(iobase, OFF);
518 EnTXFIFOHalfLevelInt(iobase, OFF);
519 EnTXFIFOUnderrunEOMInt(iobase, ON);
520 EnTXFIFOReadyInt(iobase, OFF);
521 InvertTX(iobase, OFF);
522 InvertRX(iobase, OFF);
523
524 if (ReadLPCReg(0x20) == 0x3c)
525 WriteLPCReg(0xF0, 0); // for VT1211
526 /* Int Init */
527 EnRXSpecInt(iobase, ON);
528
529 /* The following is basically hwreset */
530 /* If this is the case, why not just call hwreset() ? Jean II */
531 ResetChip(iobase, 5);
532 EnableDMA(iobase, OFF);
533 EnableTX(iobase, OFF);
534 EnableRX(iobase, OFF);
535 EnRXDMA(iobase, OFF);
536 EnTXDMA(iobase, OFF);
537 RXStart(iobase, OFF);
538 TXStart(iobase, OFF);
539 InitCard(iobase);
540 CommonInit(iobase);
541 SIRFilter(iobase, ON);
542 SetSIR(iobase, ON);
543 CRC16(iobase, ON);
544 EnTXCRC(iobase, 0);
545 WriteReg(iobase, I_ST_CT_0, 0x00);
546 SetBaudRate(iobase, 9600);
547 SetPulseWidth(iobase, 12);
548 SetSendPreambleCount(iobase, 0);
549
550 self->io.speed = 9600;
551 self->st_fifo.len = 0;
552
553 via_ircc_change_dongle_speed(iobase, self->io.speed,
554 self->io.dongle_id);
555
556 WriteReg(iobase, I_ST_CT_0, 0x80);
557 }
558
559 /*
560 * Function via_ircc_read_dongle_id (void)
561 *
562 */
563 static int via_ircc_read_dongle_id(int iobase)
564 {
565 int dongle_id = 9; /* Default to IBM */
566
567 IRDA_ERROR("via-ircc: dongle probing not supported, please specify dongle_id module parameter.\n");
568 return dongle_id;
569 }
570
571 /*
572 * Function via_ircc_change_dongle_speed (iobase, speed, dongle_id)
573 * Change speed of the attach dongle
574 * only implement two type of dongle currently.
575 */
576 static void via_ircc_change_dongle_speed(int iobase, int speed,
577 int dongle_id)
578 {
579 u8 mode = 0;
580
581 /* speed is unused, as we use IsSIROn()/IsMIROn() */
582 speed = speed;
583
584 IRDA_DEBUG(1, "%s(): change_dongle_speed to %d for 0x%x, %d\n",
585 __FUNCTION__, speed, iobase, dongle_id);
586
587 switch (dongle_id) {
588
589 /* Note: The dongle_id's listed here are derived from
590 * nsc-ircc.c */
591
592 case 0x08: /* HP HSDL-2300, HP HSDL-3600/HSDL-3610 */
593 UseOneRX(iobase, ON); // use one RX pin RX1,RX2
594 InvertTX(iobase, OFF);
595 InvertRX(iobase, OFF);
596
597 EnRX2(iobase, ON); //sir to rx2
598 EnGPIOtoRX2(iobase, OFF);
599
600 if (IsSIROn(iobase)) { //sir
601 // Mode select Off
602 SlowIRRXLowActive(iobase, ON);
603 udelay(1000);
604 SlowIRRXLowActive(iobase, OFF);
605 } else {
606 if (IsMIROn(iobase)) { //mir
607 // Mode select On
608 SlowIRRXLowActive(iobase, OFF);
609 udelay(20);
610 } else { // fir
611 if (IsFIROn(iobase)) { //fir
612 // Mode select On
613 SlowIRRXLowActive(iobase, OFF);
614 udelay(20);
615 }
616 }
617 }
618 break;
619
620 case 0x09: /* IBM31T1100 or Temic TFDS6000/TFDS6500 */
621 UseOneRX(iobase, ON); //use ONE RX....RX1
622 InvertTX(iobase, OFF);
623 InvertRX(iobase, OFF); // invert RX pin
624
625 EnRX2(iobase, ON);
626 EnGPIOtoRX2(iobase, OFF);
627 if (IsSIROn(iobase)) { //sir
628 // Mode select On
629 SlowIRRXLowActive(iobase, ON);
630 udelay(20);
631 // Mode select Off
632 SlowIRRXLowActive(iobase, OFF);
633 }
634 if (IsMIROn(iobase)) { //mir
635 // Mode select On
636 SlowIRRXLowActive(iobase, OFF);
637 udelay(20);
638 // Mode select Off
639 SlowIRRXLowActive(iobase, ON);
640 } else { // fir
641 if (IsFIROn(iobase)) { //fir
642 // Mode select On
643 SlowIRRXLowActive(iobase, OFF);
644 // TX On
645 WriteTX(iobase, ON);
646 udelay(20);
647 // Mode select OFF
648 SlowIRRXLowActive(iobase, ON);
649 udelay(20);
650 // TX Off
651 WriteTX(iobase, OFF);
652 }
653 }
654 break;
655
656 case 0x0d:
657 UseOneRX(iobase, OFF); // use two RX pin RX1,RX2
658 InvertTX(iobase, OFF);
659 InvertRX(iobase, OFF);
660 SlowIRRXLowActive(iobase, OFF);
661 if (IsSIROn(iobase)) { //sir
662 EnGPIOtoRX2(iobase, OFF);
663 WriteGIO(iobase, OFF);
664 EnRX2(iobase, OFF); //sir to rx2
665 } else { // fir mir
666 EnGPIOtoRX2(iobase, OFF);
667 WriteGIO(iobase, OFF);
668 EnRX2(iobase, OFF); //fir to rx
669 }
670 break;
671
672 case 0x11: /* Temic TFDS4500 */
673
674 IRDA_DEBUG(2, "%s: Temic TFDS4500: One RX pin, TX normal, RX inverted.\n", __FUNCTION__);
675
676 UseOneRX(iobase, ON); //use ONE RX....RX1
677 InvertTX(iobase, OFF);
678 InvertRX(iobase, ON); // invert RX pin
679
680 EnRX2(iobase, ON); //sir to rx2
681 EnGPIOtoRX2(iobase, OFF);
682
683 if( IsSIROn(iobase) ){ //sir
684
685 // Mode select On
686 SlowIRRXLowActive(iobase, ON);
687 udelay(20);
688 // Mode select Off
689 SlowIRRXLowActive(iobase, OFF);
690
691 } else{
692 IRDA_DEBUG(0, "%s: Warning: TFDS4500 not running in SIR mode !\n", __FUNCTION__);
693 }
694 break;
695
696 case 0x0ff: /* Vishay */
697 if (IsSIROn(iobase))
698 mode = 0;
699 else if (IsMIROn(iobase))
700 mode = 1;
701 else if (IsFIROn(iobase))
702 mode = 2;
703 else if (IsVFIROn(iobase))
704 mode = 5; //VFIR-16
705 SI_SetMode(iobase, mode);
706 break;
707
708 default:
709 IRDA_ERROR("%s: Error: dongle_id %d unsupported !\n",
710 __FUNCTION__, dongle_id);
711 }
712 }
713
714 /*
715 * Function via_ircc_change_speed (self, baud)
716 *
717 * Change the speed of the device
718 *
719 */
720 static void via_ircc_change_speed(struct via_ircc_cb *self, __u32 speed)
721 {
722 struct net_device *dev = self->netdev;
723 u16 iobase;
724 u8 value = 0, bTmp;
725
726 iobase = self->io.fir_base;
727 /* Update accounting for new speed */
728 self->io.speed = speed;
729 IRDA_DEBUG(1, "%s: change_speed to %d bps.\n", __FUNCTION__, speed);
730
731 WriteReg(iobase, I_ST_CT_0, 0x0);
732
733 /* Controller mode sellection */
734 switch (speed) {
735 case 2400:
736 case 9600:
737 case 19200:
738 case 38400:
739 case 57600:
740 case 115200:
741 value = (115200/speed)-1;
742 SetSIR(iobase, ON);
743 CRC16(iobase, ON);
744 break;
745 case 576000:
746 /* FIXME: this can't be right, as it's the same as 115200,
747 * and 576000 is MIR, not SIR. */
748 value = 0;
749 SetSIR(iobase, ON);
750 CRC16(iobase, ON);
751 break;
752 case 1152000:
753 value = 0;
754 SetMIR(iobase, ON);
755 /* FIXME: CRC ??? */
756 break;
757 case 4000000:
758 value = 0;
759 SetFIR(iobase, ON);
760 SetPulseWidth(iobase, 0);
761 SetSendPreambleCount(iobase, 14);
762 CRC16(iobase, OFF);
763 EnTXCRC(iobase, ON);
764 break;
765 case 16000000:
766 value = 0;
767 SetVFIR(iobase, ON);
768 /* FIXME: CRC ??? */
769 break;
770 default:
771 value = 0;
772 break;
773 }
774
775 /* Set baudrate to 0x19[2..7] */
776 bTmp = (ReadReg(iobase, I_CF_H_1) & 0x03);
777 bTmp |= value << 2;
778 WriteReg(iobase, I_CF_H_1, bTmp);
779
780 /* Some dongles may need to be informed about speed changes. */
781 via_ircc_change_dongle_speed(iobase, speed, self->io.dongle_id);
782
783 /* Set FIFO size to 64 */
784 SetFIFO(iobase, 64);
785
786 /* Enable IR */
787 WriteReg(iobase, I_ST_CT_0, 0x80);
788
789 // EnTXFIFOHalfLevelInt(iobase,ON);
790
791 /* Enable some interrupts so we can receive frames */
792 //EnAllInt(iobase,ON);
793
794 if (IsSIROn(iobase)) {
795 SIRFilter(iobase, ON);
796 SIRRecvAny(iobase, ON);
797 } else {
798 SIRFilter(iobase, OFF);
799 SIRRecvAny(iobase, OFF);
800 }
801
802 if (speed > 115200) {
803 /* Install FIR xmit handler */
804 dev->hard_start_xmit = via_ircc_hard_xmit_fir;
805 via_ircc_dma_receive(self);
806 } else {
807 /* Install SIR xmit handler */
808 dev->hard_start_xmit = via_ircc_hard_xmit_sir;
809 }
810 netif_wake_queue(dev);
811 }
812
813 /*
814 * Function via_ircc_hard_xmit (skb, dev)
815 *
816 * Transmit the frame!
817 *
818 */
819 static int via_ircc_hard_xmit_sir(struct sk_buff *skb,
820 struct net_device *dev)
821 {
822 struct via_ircc_cb *self;
823 unsigned long flags;
824 u16 iobase;
825 __u32 speed;
826
827 self = (struct via_ircc_cb *) dev->priv;
828 IRDA_ASSERT(self != NULL, return 0;);
829 iobase = self->io.fir_base;
830
831 netif_stop_queue(dev);
832 /* Check if we need to change the speed */
833 speed = irda_get_next_speed(skb);
834 if ((speed != self->io.speed) && (speed != -1)) {
835 /* Check for empty frame */
836 if (!skb->len) {
837 via_ircc_change_speed(self, speed);
838 dev->trans_start = jiffies;
839 dev_kfree_skb(skb);
840 return 0;
841 } else
842 self->new_speed = speed;
843 }
844 InitCard(iobase);
845 CommonInit(iobase);
846 SIRFilter(iobase, ON);
847 SetSIR(iobase, ON);
848 CRC16(iobase, ON);
849 EnTXCRC(iobase, 0);
850 WriteReg(iobase, I_ST_CT_0, 0x00);
851
852 spin_lock_irqsave(&self->lock, flags);
853 self->tx_buff.data = self->tx_buff.head;
854 self->tx_buff.len =
855 async_wrap_skb(skb, self->tx_buff.data,
856 self->tx_buff.truesize);
857
858 self->stats.tx_bytes += self->tx_buff.len;
859 /* Send this frame with old speed */
860 SetBaudRate(iobase, self->io.speed);
861 SetPulseWidth(iobase, 12);
862 SetSendPreambleCount(iobase, 0);
863 WriteReg(iobase, I_ST_CT_0, 0x80);
864
865 EnableTX(iobase, ON);
866 EnableRX(iobase, OFF);
867
868 ResetChip(iobase, 0);
869 ResetChip(iobase, 1);
870 ResetChip(iobase, 2);
871 ResetChip(iobase, 3);
872 ResetChip(iobase, 4);
873
874 EnAllInt(iobase, ON);
875 EnTXDMA(iobase, ON);
876 EnRXDMA(iobase, OFF);
877
878 irda_setup_dma(self->io.dma, self->tx_buff_dma, self->tx_buff.len,
879 DMA_TX_MODE);
880
881 SetSendByte(iobase, self->tx_buff.len);
882 RXStart(iobase, OFF);
883 TXStart(iobase, ON);
884
885 dev->trans_start = jiffies;
886 spin_unlock_irqrestore(&self->lock, flags);
887 dev_kfree_skb(skb);
888 return 0;
889 }
890
891 static int via_ircc_hard_xmit_fir(struct sk_buff *skb,
892 struct net_device *dev)
893 {
894 struct via_ircc_cb *self;
895 u16 iobase;
896 __u32 speed;
897 unsigned long flags;
898
899 self = (struct via_ircc_cb *) dev->priv;
900 iobase = self->io.fir_base;
901
902 if (self->st_fifo.len)
903 return 0;
904 if (self->chip_id == 0x3076)
905 iodelay(1500);
906 else
907 udelay(1500);
908 netif_stop_queue(dev);
909 speed = irda_get_next_speed(skb);
910 if ((speed != self->io.speed) && (speed != -1)) {
911 if (!skb->len) {
912 via_ircc_change_speed(self, speed);
913 dev->trans_start = jiffies;
914 dev_kfree_skb(skb);
915 return 0;
916 } else
917 self->new_speed = speed;
918 }
919 spin_lock_irqsave(&self->lock, flags);
920 self->tx_fifo.queue[self->tx_fifo.free].start = self->tx_fifo.tail;
921 self->tx_fifo.queue[self->tx_fifo.free].len = skb->len;
922
923 self->tx_fifo.tail += skb->len;
924 self->stats.tx_bytes += skb->len;
925 skb_copy_from_linear_data(skb,
926 self->tx_fifo.queue[self->tx_fifo.free].start, skb->len);
927 self->tx_fifo.len++;
928 self->tx_fifo.free++;
929 //F01 if (self->tx_fifo.len == 1) {
930 via_ircc_dma_xmit(self, iobase);
931 //F01 }
932 //F01 if (self->tx_fifo.free < (MAX_TX_WINDOW -1 )) netif_wake_queue(self->netdev);
933 dev->trans_start = jiffies;
934 dev_kfree_skb(skb);
935 spin_unlock_irqrestore(&self->lock, flags);
936 return 0;
937
938 }
939
940 static int via_ircc_dma_xmit(struct via_ircc_cb *self, u16 iobase)
941 {
942 EnTXDMA(iobase, OFF);
943 self->io.direction = IO_XMIT;
944 EnPhys(iobase, ON);
945 EnableTX(iobase, ON);
946 EnableRX(iobase, OFF);
947 ResetChip(iobase, 0);
948 ResetChip(iobase, 1);
949 ResetChip(iobase, 2);
950 ResetChip(iobase, 3);
951 ResetChip(iobase, 4);
952 EnAllInt(iobase, ON);
953 EnTXDMA(iobase, ON);
954 EnRXDMA(iobase, OFF);
955 irda_setup_dma(self->io.dma,
956 ((u8 *)self->tx_fifo.queue[self->tx_fifo.ptr].start -
957 self->tx_buff.head) + self->tx_buff_dma,
958 self->tx_fifo.queue[self->tx_fifo.ptr].len, DMA_TX_MODE);
959 IRDA_DEBUG(1, "%s: tx_fifo.ptr=%x,len=%x,tx_fifo.len=%x..\n",
960 __FUNCTION__, self->tx_fifo.ptr,
961 self->tx_fifo.queue[self->tx_fifo.ptr].len,
962 self->tx_fifo.len);
963
964 SetSendByte(iobase, self->tx_fifo.queue[self->tx_fifo.ptr].len);
965 RXStart(iobase, OFF);
966 TXStart(iobase, ON);
967 return 0;
968
969 }
970
971 /*
972 * Function via_ircc_dma_xmit_complete (self)
973 *
974 * The transfer of a frame in finished. This function will only be called
975 * by the interrupt handler
976 *
977 */
978 static int via_ircc_dma_xmit_complete(struct via_ircc_cb *self)
979 {
980 int iobase;
981 int ret = TRUE;
982 u8 Tx_status;
983
984 IRDA_DEBUG(3, "%s()\n", __FUNCTION__);
985
986 iobase = self->io.fir_base;
987 /* Disable DMA */
988 // DisableDmaChannel(self->io.dma);
989 /* Check for underrrun! */
990 /* Clear bit, by writing 1 into it */
991 Tx_status = GetTXStatus(iobase);
992 if (Tx_status & 0x08) {
993 self->stats.tx_errors++;
994 self->stats.tx_fifo_errors++;
995 hwreset(self);
996 // how to clear underrrun ?
997 } else {
998 self->stats.tx_packets++;
999 ResetChip(iobase, 3);
1000 ResetChip(iobase, 4);
1001 }
1002 /* Check if we need to change the speed */
1003 if (self->new_speed) {
1004 via_ircc_change_speed(self, self->new_speed);
1005 self->new_speed = 0;
1006 }
1007
1008 /* Finished with this frame, so prepare for next */
1009 if (IsFIROn(iobase)) {
1010 if (self->tx_fifo.len) {
1011 self->tx_fifo.len--;
1012 self->tx_fifo.ptr++;
1013 }
1014 }
1015 IRDA_DEBUG(1,
1016 "%s: tx_fifo.len=%x ,tx_fifo.ptr=%x,tx_fifo.free=%x...\n",
1017 __FUNCTION__,
1018 self->tx_fifo.len, self->tx_fifo.ptr, self->tx_fifo.free);
1019 /* F01_S
1020 // Any frames to be sent back-to-back?
1021 if (self->tx_fifo.len) {
1022 // Not finished yet!
1023 via_ircc_dma_xmit(self, iobase);
1024 ret = FALSE;
1025 } else {
1026 F01_E*/
1027 // Reset Tx FIFO info
1028 self->tx_fifo.len = self->tx_fifo.ptr = self->tx_fifo.free = 0;
1029 self->tx_fifo.tail = self->tx_buff.head;
1030 //F01 }
1031
1032 // Make sure we have room for more frames
1033 //F01 if (self->tx_fifo.free < (MAX_TX_WINDOW -1 )) {
1034 // Not busy transmitting anymore
1035 // Tell the network layer, that we can accept more frames
1036 netif_wake_queue(self->netdev);
1037 //F01 }
1038 return ret;
1039 }
1040
1041 /*
1042 * Function via_ircc_dma_receive (self)
1043 *
1044 * Set configuration for receive a frame.
1045 *
1046 */
1047 static int via_ircc_dma_receive(struct via_ircc_cb *self)
1048 {
1049 int iobase;
1050
1051 iobase = self->io.fir_base;
1052
1053 IRDA_DEBUG(3, "%s()\n", __FUNCTION__);
1054
1055 self->tx_fifo.len = self->tx_fifo.ptr = self->tx_fifo.free = 0;
1056 self->tx_fifo.tail = self->tx_buff.head;
1057 self->RxDataReady = 0;
1058 self->io.direction = IO_RECV;
1059 self->rx_buff.data = self->rx_buff.head;
1060 self->st_fifo.len = self->st_fifo.pending_bytes = 0;
1061 self->st_fifo.tail = self->st_fifo.head = 0;
1062
1063 EnPhys(iobase, ON);
1064 EnableTX(iobase, OFF);
1065 EnableRX(iobase, ON);
1066
1067 ResetChip(iobase, 0);
1068 ResetChip(iobase, 1);
1069 ResetChip(iobase, 2);
1070 ResetChip(iobase, 3);
1071 ResetChip(iobase, 4);
1072
1073 EnAllInt(iobase, ON);
1074 EnTXDMA(iobase, OFF);
1075 EnRXDMA(iobase, ON);
1076 irda_setup_dma(self->io.dma2, self->rx_buff_dma,
1077 self->rx_buff.truesize, DMA_RX_MODE);
1078 TXStart(iobase, OFF);
1079 RXStart(iobase, ON);
1080
1081 return 0;
1082 }
1083
1084 /*
1085 * Function via_ircc_dma_receive_complete (self)
1086 *
1087 * Controller Finished with receiving frames,
1088 * and this routine is call by ISR
1089 *
1090 */
1091 static int via_ircc_dma_receive_complete(struct via_ircc_cb *self,
1092 int iobase)
1093 {
1094 struct st_fifo *st_fifo;
1095 struct sk_buff *skb;
1096 int len, i;
1097 u8 status = 0;
1098
1099 iobase = self->io.fir_base;
1100 st_fifo = &self->st_fifo;
1101
1102 if (self->io.speed < 4000000) { //Speed below FIR
1103 len = GetRecvByte(iobase, self);
1104 skb = dev_alloc_skb(len + 1);
1105 if (skb == NULL)
1106 return FALSE;
1107 // Make sure IP header gets aligned
1108 skb_reserve(skb, 1);
1109 skb_put(skb, len - 2);
1110 if (self->chip_id == 0x3076) {
1111 for (i = 0; i < len - 2; i++)
1112 skb->data[i] = self->rx_buff.data[i * 2];
1113 } else {
1114 if (self->chip_id == 0x3096) {
1115 for (i = 0; i < len - 2; i++)
1116 skb->data[i] =
1117 self->rx_buff.data[i];
1118 }
1119 }
1120 // Move to next frame
1121 self->rx_buff.data += len;
1122 self->stats.rx_bytes += len;
1123 self->stats.rx_packets++;
1124 skb->dev = self->netdev;
1125 skb_reset_mac_header(skb);
1126 skb->protocol = htons(ETH_P_IRDA);
1127 netif_rx(skb);
1128 return TRUE;
1129 }
1130
1131 else { //FIR mode
1132 len = GetRecvByte(iobase, self);
1133 if (len == 0)
1134 return TRUE; //interrupt only, data maybe move by RxT
1135 if (((len - 4) < 2) || ((len - 4) > 2048)) {
1136 IRDA_DEBUG(1, "%s(): Trouble:len=%x,CurCount=%x,LastCount=%x..\n",
1137 __FUNCTION__, len, RxCurCount(iobase, self),
1138 self->RxLastCount);
1139 hwreset(self);
1140 return FALSE;
1141 }
1142 IRDA_DEBUG(2, "%s(): fifo.len=%x,len=%x,CurCount=%x..\n",
1143 __FUNCTION__,
1144 st_fifo->len, len - 4, RxCurCount(iobase, self));
1145
1146 st_fifo->entries[st_fifo->tail].status = status;
1147 st_fifo->entries[st_fifo->tail].len = len;
1148 st_fifo->pending_bytes += len;
1149 st_fifo->tail++;
1150 st_fifo->len++;
1151 if (st_fifo->tail > MAX_RX_WINDOW)
1152 st_fifo->tail = 0;
1153 self->RxDataReady = 0;
1154
1155 // It maybe have MAX_RX_WINDOW package receive by
1156 // receive_complete before Timer IRQ
1157 /* F01_S
1158 if (st_fifo->len < (MAX_RX_WINDOW+2 )) {
1159 RXStart(iobase,ON);
1160 SetTimer(iobase,4);
1161 }
1162 else {
1163 F01_E */
1164 EnableRX(iobase, OFF);
1165 EnRXDMA(iobase, OFF);
1166 RXStart(iobase, OFF);
1167 //F01_S
1168 // Put this entry back in fifo
1169 if (st_fifo->head > MAX_RX_WINDOW)
1170 st_fifo->head = 0;
1171 status = st_fifo->entries[st_fifo->head].status;
1172 len = st_fifo->entries[st_fifo->head].len;
1173 st_fifo->head++;
1174 st_fifo->len--;
1175
1176 skb = dev_alloc_skb(len + 1 - 4);
1177 /*
1178 * if frame size,data ptr,or skb ptr are wrong ,the get next
1179 * entry.
1180 */
1181 if ((skb == NULL) || (skb->data == NULL)
1182 || (self->rx_buff.data == NULL) || (len < 6)) {
1183 self->stats.rx_dropped++;
1184 return TRUE;
1185 }
1186 skb_reserve(skb, 1);
1187 skb_put(skb, len - 4);
1188
1189 skb_copy_to_linear_data(skb, self->rx_buff.data, len - 4);
1190 IRDA_DEBUG(2, "%s(): len=%x.rx_buff=%p\n", __FUNCTION__,
1191 len - 4, self->rx_buff.data);
1192
1193 // Move to next frame
1194 self->rx_buff.data += len;
1195 self->stats.rx_bytes += len;
1196 self->stats.rx_packets++;
1197 skb->dev = self->netdev;
1198 skb_reset_mac_header(skb);
1199 skb->protocol = htons(ETH_P_IRDA);
1200 netif_rx(skb);
1201
1202 //F01_E
1203 } //FIR
1204 return TRUE;
1205
1206 }
1207
1208 /*
1209 * if frame is received , but no INT ,then use this routine to upload frame.
1210 */
1211 static int upload_rxdata(struct via_ircc_cb *self, int iobase)
1212 {
1213 struct sk_buff *skb;
1214 int len;
1215 struct st_fifo *st_fifo;
1216 st_fifo = &self->st_fifo;
1217
1218 len = GetRecvByte(iobase, self);
1219
1220 IRDA_DEBUG(2, "%s(): len=%x\n", __FUNCTION__, len);
1221
1222 if ((len - 4) < 2) {
1223 self->stats.rx_dropped++;
1224 return FALSE;
1225 }
1226
1227 skb = dev_alloc_skb(len + 1);
1228 if (skb == NULL) {
1229 self->stats.rx_dropped++;
1230 return FALSE;
1231 }
1232 skb_reserve(skb, 1);
1233 skb_put(skb, len - 4 + 1);
1234 skb_copy_to_linear_data(skb, self->rx_buff.data, len - 4 + 1);
1235 st_fifo->tail++;
1236 st_fifo->len++;
1237 if (st_fifo->tail > MAX_RX_WINDOW)
1238 st_fifo->tail = 0;
1239 // Move to next frame
1240 self->rx_buff.data += len;
1241 self->stats.rx_bytes += len;
1242 self->stats.rx_packets++;
1243 skb->dev = self->netdev;
1244 skb_reset_mac_header(skb);
1245 skb->protocol = htons(ETH_P_IRDA);
1246 netif_rx(skb);
1247 if (st_fifo->len < (MAX_RX_WINDOW + 2)) {
1248 RXStart(iobase, ON);
1249 } else {
1250 EnableRX(iobase, OFF);
1251 EnRXDMA(iobase, OFF);
1252 RXStart(iobase, OFF);
1253 }
1254 return TRUE;
1255 }
1256
1257 /*
1258 * Implement back to back receive , use this routine to upload data.
1259 */
1260
1261 static int RxTimerHandler(struct via_ircc_cb *self, int iobase)
1262 {
1263 struct st_fifo *st_fifo;
1264 struct sk_buff *skb;
1265 int len;
1266 u8 status;
1267
1268 st_fifo = &self->st_fifo;
1269
1270 if (CkRxRecv(iobase, self)) {
1271 // if still receiving ,then return ,don't upload frame
1272 self->RetryCount = 0;
1273 SetTimer(iobase, 20);
1274 self->RxDataReady++;
1275 return FALSE;
1276 } else
1277 self->RetryCount++;
1278
1279 if ((self->RetryCount >= 1) ||
1280 ((st_fifo->pending_bytes + 2048) > self->rx_buff.truesize)
1281 || (st_fifo->len >= (MAX_RX_WINDOW))) {
1282 while (st_fifo->len > 0) { //upload frame
1283 // Put this entry back in fifo
1284 if (st_fifo->head > MAX_RX_WINDOW)
1285 st_fifo->head = 0;
1286 status = st_fifo->entries[st_fifo->head].status;
1287 len = st_fifo->entries[st_fifo->head].len;
1288 st_fifo->head++;
1289 st_fifo->len--;
1290
1291 skb = dev_alloc_skb(len + 1 - 4);
1292 /*
1293 * if frame size, data ptr, or skb ptr are wrong,
1294 * then get next entry.
1295 */
1296 if ((skb == NULL) || (skb->data == NULL)
1297 || (self->rx_buff.data == NULL) || (len < 6)) {
1298 self->stats.rx_dropped++;
1299 continue;
1300 }
1301 skb_reserve(skb, 1);
1302 skb_put(skb, len - 4);
1303 skb_copy_to_linear_data(skb, self->rx_buff.data, len - 4);
1304
1305 IRDA_DEBUG(2, "%s(): len=%x.head=%x\n", __FUNCTION__,
1306 len - 4, st_fifo->head);
1307
1308 // Move to next frame
1309 self->rx_buff.data += len;
1310 self->stats.rx_bytes += len;
1311 self->stats.rx_packets++;
1312 skb->dev = self->netdev;
1313 skb_reset_mac_header(skb);
1314 skb->protocol = htons(ETH_P_IRDA);
1315 netif_rx(skb);
1316 } //while
1317 self->RetryCount = 0;
1318
1319 IRDA_DEBUG(2,
1320 "%s(): End of upload HostStatus=%x,RxStatus=%x\n",
1321 __FUNCTION__,
1322 GetHostStatus(iobase), GetRXStatus(iobase));
1323
1324 /*
1325 * if frame is receive complete at this routine ,then upload
1326 * frame.
1327 */
1328 if ((GetRXStatus(iobase) & 0x10)
1329 && (RxCurCount(iobase, self) != self->RxLastCount)) {
1330 upload_rxdata(self, iobase);
1331 if (irda_device_txqueue_empty(self->netdev))
1332 via_ircc_dma_receive(self);
1333 }
1334 } // timer detect complete
1335 else
1336 SetTimer(iobase, 4);
1337 return TRUE;
1338
1339 }
1340
1341
1342
1343 /*
1344 * Function via_ircc_interrupt (irq, dev_id)
1345 *
1346 * An interrupt from the chip has arrived. Time to do some work
1347 *
1348 */
1349 static irqreturn_t via_ircc_interrupt(int irq, void *dev_id)
1350 {
1351 struct net_device *dev = (struct net_device *) dev_id;
1352 struct via_ircc_cb *self;
1353 int iobase;
1354 u8 iHostIntType, iRxIntType, iTxIntType;
1355
1356 if (!dev) {
1357 IRDA_WARNING("%s: irq %d for unknown device.\n", driver_name,
1358 irq);
1359 return IRQ_NONE;
1360 }
1361 self = (struct via_ircc_cb *) dev->priv;
1362 iobase = self->io.fir_base;
1363 spin_lock(&self->lock);
1364 iHostIntType = GetHostStatus(iobase);
1365
1366 IRDA_DEBUG(4, "%s(): iHostIntType %02x: %s %s %s %02x\n",
1367 __FUNCTION__, iHostIntType,
1368 (iHostIntType & 0x40) ? "Timer" : "",
1369 (iHostIntType & 0x20) ? "Tx" : "",
1370 (iHostIntType & 0x10) ? "Rx" : "",
1371 (iHostIntType & 0x0e) >> 1);
1372
1373 if ((iHostIntType & 0x40) != 0) { //Timer Event
1374 self->EventFlag.TimeOut++;
1375 ClearTimerInt(iobase, 1);
1376 if (self->io.direction == IO_XMIT) {
1377 via_ircc_dma_xmit(self, iobase);
1378 }
1379 if (self->io.direction == IO_RECV) {
1380 /*
1381 * frame ready hold too long, must reset.
1382 */
1383 if (self->RxDataReady > 30) {
1384 hwreset(self);
1385 if (irda_device_txqueue_empty(self->netdev)) {
1386 via_ircc_dma_receive(self);
1387 }
1388 } else { // call this to upload frame.
1389 RxTimerHandler(self, iobase);
1390 }
1391 } //RECV
1392 } //Timer Event
1393 if ((iHostIntType & 0x20) != 0) { //Tx Event
1394 iTxIntType = GetTXStatus(iobase);
1395
1396 IRDA_DEBUG(4, "%s(): iTxIntType %02x: %s %s %s %s\n",
1397 __FUNCTION__, iTxIntType,
1398 (iTxIntType & 0x08) ? "FIFO underr." : "",
1399 (iTxIntType & 0x04) ? "EOM" : "",
1400 (iTxIntType & 0x02) ? "FIFO ready" : "",
1401 (iTxIntType & 0x01) ? "Early EOM" : "");
1402
1403 if (iTxIntType & 0x4) {
1404 self->EventFlag.EOMessage++; // read and will auto clean
1405 if (via_ircc_dma_xmit_complete(self)) {
1406 if (irda_device_txqueue_empty
1407 (self->netdev)) {
1408 via_ircc_dma_receive(self);
1409 }
1410 } else {
1411 self->EventFlag.Unknown++;
1412 }
1413 } //EOP
1414 } //Tx Event
1415 //----------------------------------------
1416 if ((iHostIntType & 0x10) != 0) { //Rx Event
1417 /* Check if DMA has finished */
1418 iRxIntType = GetRXStatus(iobase);
1419
1420 IRDA_DEBUG(4, "%s(): iRxIntType %02x: %s %s %s %s %s %s %s\n",
1421 __FUNCTION__, iRxIntType,
1422 (iRxIntType & 0x80) ? "PHY err." : "",
1423 (iRxIntType & 0x40) ? "CRC err" : "",
1424 (iRxIntType & 0x20) ? "FIFO overr." : "",
1425 (iRxIntType & 0x10) ? "EOF" : "",
1426 (iRxIntType & 0x08) ? "RxData" : "",
1427 (iRxIntType & 0x02) ? "RxMaxLen" : "",
1428 (iRxIntType & 0x01) ? "SIR bad" : "");
1429 if (!iRxIntType)
1430 IRDA_DEBUG(3, "%s(): RxIRQ =0\n", __FUNCTION__);
1431
1432 if (iRxIntType & 0x10) {
1433 if (via_ircc_dma_receive_complete(self, iobase)) {
1434 //F01 if(!(IsFIROn(iobase))) via_ircc_dma_receive(self);
1435 via_ircc_dma_receive(self);
1436 }
1437 } // No ERR
1438 else { //ERR
1439 IRDA_DEBUG(4, "%s(): RxIRQ ERR:iRxIntType=%x,HostIntType=%x,CurCount=%x,RxLastCount=%x_____\n",
1440 __FUNCTION__, iRxIntType, iHostIntType,
1441 RxCurCount(iobase, self),
1442 self->RxLastCount);
1443
1444 if (iRxIntType & 0x20) { //FIFO OverRun ERR
1445 ResetChip(iobase, 0);
1446 ResetChip(iobase, 1);
1447 } else { //PHY,CRC ERR
1448
1449 if (iRxIntType != 0x08)
1450 hwreset(self); //F01
1451 }
1452 via_ircc_dma_receive(self);
1453 } //ERR
1454
1455 } //Rx Event
1456 spin_unlock(&self->lock);
1457 return IRQ_RETVAL(iHostIntType);
1458 }
1459
1460 static void hwreset(struct via_ircc_cb *self)
1461 {
1462 int iobase;
1463 iobase = self->io.fir_base;
1464
1465 IRDA_DEBUG(3, "%s()\n", __FUNCTION__);
1466
1467 ResetChip(iobase, 5);
1468 EnableDMA(iobase, OFF);
1469 EnableTX(iobase, OFF);
1470 EnableRX(iobase, OFF);
1471 EnRXDMA(iobase, OFF);
1472 EnTXDMA(iobase, OFF);
1473 RXStart(iobase, OFF);
1474 TXStart(iobase, OFF);
1475 InitCard(iobase);
1476 CommonInit(iobase);
1477 SIRFilter(iobase, ON);
1478 SetSIR(iobase, ON);
1479 CRC16(iobase, ON);
1480 EnTXCRC(iobase, 0);
1481 WriteReg(iobase, I_ST_CT_0, 0x00);
1482 SetBaudRate(iobase, 9600);
1483 SetPulseWidth(iobase, 12);
1484 SetSendPreambleCount(iobase, 0);
1485 WriteReg(iobase, I_ST_CT_0, 0x80);
1486
1487 /* Restore speed. */
1488 via_ircc_change_speed(self, self->io.speed);
1489
1490 self->st_fifo.len = 0;
1491 }
1492
1493 /*
1494 * Function via_ircc_is_receiving (self)
1495 *
1496 * Return TRUE is we are currently receiving a frame
1497 *
1498 */
1499 static int via_ircc_is_receiving(struct via_ircc_cb *self)
1500 {
1501 int status = FALSE;
1502 int iobase;
1503
1504 IRDA_ASSERT(self != NULL, return FALSE;);
1505
1506 iobase = self->io.fir_base;
1507 if (CkRxRecv(iobase, self))
1508 status = TRUE;
1509
1510 IRDA_DEBUG(2, "%s(): status=%x....\n", __FUNCTION__, status);
1511
1512 return status;
1513 }
1514
1515
1516 /*
1517 * Function via_ircc_net_open (dev)
1518 *
1519 * Start the device
1520 *
1521 */
1522 static int via_ircc_net_open(struct net_device *dev)
1523 {
1524 struct via_ircc_cb *self;
1525 int iobase;
1526 char hwname[32];
1527
1528 IRDA_DEBUG(3, "%s()\n", __FUNCTION__);
1529
1530 IRDA_ASSERT(dev != NULL, return -1;);
1531 self = (struct via_ircc_cb *) dev->priv;
1532 self->stats.rx_packets = 0;
1533 IRDA_ASSERT(self != NULL, return 0;);
1534 iobase = self->io.fir_base;
1535 if (request_irq(self->io.irq, via_ircc_interrupt, 0, dev->name, dev)) {
1536 IRDA_WARNING("%s, unable to allocate irq=%d\n", driver_name,
1537 self->io.irq);
1538 return -EAGAIN;
1539 }
1540 /*
1541 * Always allocate the DMA channel after the IRQ, and clean up on
1542 * failure.
1543 */
1544 if (request_dma(self->io.dma, dev->name)) {
1545 IRDA_WARNING("%s, unable to allocate dma=%d\n", driver_name,
1546 self->io.dma);
1547 free_irq(self->io.irq, self);
1548 return -EAGAIN;
1549 }
1550 if (self->io.dma2 != self->io.dma) {
1551 if (request_dma(self->io.dma2, dev->name)) {
1552 IRDA_WARNING("%s, unable to allocate dma2=%d\n",
1553 driver_name, self->io.dma2);
1554 free_irq(self->io.irq, self);
1555 return -EAGAIN;
1556 }
1557 }
1558
1559
1560 /* turn on interrupts */
1561 EnAllInt(iobase, ON);
1562 EnInternalLoop(iobase, OFF);
1563 EnExternalLoop(iobase, OFF);
1564
1565 /* */
1566 via_ircc_dma_receive(self);
1567
1568 /* Ready to play! */
1569 netif_start_queue(dev);
1570
1571 /*
1572 * Open new IrLAP layer instance, now that everything should be
1573 * initialized properly
1574 */
1575 sprintf(hwname, "VIA @ 0x%x", iobase);
1576 self->irlap = irlap_open(dev, &self->qos, hwname);
1577
1578 self->RxLastCount = 0;
1579
1580 return 0;
1581 }
1582
1583 /*
1584 * Function via_ircc_net_close (dev)
1585 *
1586 * Stop the device
1587 *
1588 */
1589 static int via_ircc_net_close(struct net_device *dev)
1590 {
1591 struct via_ircc_cb *self;
1592 int iobase;
1593
1594 IRDA_DEBUG(3, "%s()\n", __FUNCTION__);
1595
1596 IRDA_ASSERT(dev != NULL, return -1;);
1597 self = (struct via_ircc_cb *) dev->priv;
1598 IRDA_ASSERT(self != NULL, return 0;);
1599
1600 /* Stop device */
1601 netif_stop_queue(dev);
1602 /* Stop and remove instance of IrLAP */
1603 if (self->irlap)
1604 irlap_close(self->irlap);
1605 self->irlap = NULL;
1606 iobase = self->io.fir_base;
1607 EnTXDMA(iobase, OFF);
1608 EnRXDMA(iobase, OFF);
1609 DisableDmaChannel(self->io.dma);
1610
1611 /* Disable interrupts */
1612 EnAllInt(iobase, OFF);
1613 free_irq(self->io.irq, dev);
1614 free_dma(self->io.dma);
1615
1616 return 0;
1617 }
1618
1619 /*
1620 * Function via_ircc_net_ioctl (dev, rq, cmd)
1621 *
1622 * Process IOCTL commands for this device
1623 *
1624 */
1625 static int via_ircc_net_ioctl(struct net_device *dev, struct ifreq *rq,
1626 int cmd)
1627 {
1628 struct if_irda_req *irq = (struct if_irda_req *) rq;
1629 struct via_ircc_cb *self;
1630 unsigned long flags;
1631 int ret = 0;
1632
1633 IRDA_ASSERT(dev != NULL, return -1;);
1634 self = dev->priv;
1635 IRDA_ASSERT(self != NULL, return -1;);
1636 IRDA_DEBUG(1, "%s(), %s, (cmd=0x%X)\n", __FUNCTION__, dev->name,
1637 cmd);
1638 /* Disable interrupts & save flags */
1639 spin_lock_irqsave(&self->lock, flags);
1640 switch (cmd) {
1641 case SIOCSBANDWIDTH: /* Set bandwidth */
1642 if (!capable(CAP_NET_ADMIN)) {
1643 ret = -EPERM;
1644 goto out;
1645 }
1646 via_ircc_change_speed(self, irq->ifr_baudrate);
1647 break;
1648 case SIOCSMEDIABUSY: /* Set media busy */
1649 if (!capable(CAP_NET_ADMIN)) {
1650 ret = -EPERM;
1651 goto out;
1652 }
1653 irda_device_set_media_busy(self->netdev, TRUE);
1654 break;
1655 case SIOCGRECEIVING: /* Check if we are receiving right now */
1656 irq->ifr_receiving = via_ircc_is_receiving(self);
1657 break;
1658 default:
1659 ret = -EOPNOTSUPP;
1660 }
1661 out:
1662 spin_unlock_irqrestore(&self->lock, flags);
1663 return ret;
1664 }
1665
1666 static struct net_device_stats *via_ircc_net_get_stats(struct net_device
1667 *dev)
1668 {
1669 struct via_ircc_cb *self = (struct via_ircc_cb *) dev->priv;
1670
1671 return &self->stats;
1672 }
1673
1674 MODULE_AUTHOR("VIA Technologies,inc");
1675 MODULE_DESCRIPTION("VIA IrDA Device Driver");
1676 MODULE_LICENSE("GPL");
1677
1678 module_init(via_ircc_init);
1679 module_exit(via_ircc_cleanup);
Mirror for ia64_pv_ops.git