| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /********************************************************************* | 
|  | 2 | * | 
|  | 3 | * Filename:      w83977af_ir.c | 
|  | 4 | * Version:       1.0 | 
|  | 5 | * Description:   FIR driver for the Winbond W83977AF Super I/O chip | 
|  | 6 | * Status:        Experimental. | 
|  | 7 | * Author:        Paul VanderSpek | 
|  | 8 | * Created at:    Wed Nov  4 11:46:16 1998 | 
|  | 9 | * Modified at:   Fri Jan 28 12:10:59 2000 | 
|  | 10 | * Modified by:   Dag Brattli <dagb@cs.uit.no> | 
|  | 11 | * | 
|  | 12 | *     Copyright (c) 1998-2000 Dag Brattli <dagb@cs.uit.no> | 
|  | 13 | *     Copyright (c) 1998-1999 Rebel.com | 
|  | 14 | * | 
|  | 15 | *     This program is free software; you can redistribute it and/or | 
|  | 16 | *     modify it under the terms of the GNU General Public License as | 
|  | 17 | *     published by the Free Software Foundation; either version 2 of | 
|  | 18 | *     the License, or (at your option) any later version. | 
|  | 19 | * | 
|  | 20 | *     Neither Paul VanderSpek nor Rebel.com admit liability nor provide | 
|  | 21 | *     warranty for any of this software. This material is provided "AS-IS" | 
|  | 22 | *     and at no charge. | 
|  | 23 | * | 
|  | 24 | *     If you find bugs in this file, its very likely that the same bug | 
|  | 25 | *     will also be in pc87108.c since the implementations are quite | 
|  | 26 | *     similar. | 
|  | 27 | * | 
|  | 28 | *     Notice that all functions that needs to access the chip in _any_ | 
|  | 29 | *     way, must save BSR register on entry, and restore it on exit. | 
|  | 30 | *     It is _very_ important to follow this policy! | 
|  | 31 | * | 
|  | 32 | *         __u8 bank; | 
|  | 33 | * | 
|  | 34 | *         bank = inb( iobase+BSR); | 
|  | 35 | * | 
|  | 36 | *         do_your_stuff_here(); | 
|  | 37 | * | 
|  | 38 | *         outb( bank, iobase+BSR); | 
|  | 39 | * | 
|  | 40 | ********************************************************************/ | 
|  | 41 |  | 
|  | 42 | #include <linux/module.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | #include <linux/kernel.h> | 
|  | 44 | #include <linux/types.h> | 
|  | 45 | #include <linux/skbuff.h> | 
|  | 46 | #include <linux/netdevice.h> | 
|  | 47 | #include <linux/ioport.h> | 
|  | 48 | #include <linux/delay.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 49 | #include <linux/init.h> | 
|  | 50 | #include <linux/rtnetlink.h> | 
|  | 51 | #include <linux/dma-mapping.h> | 
| Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 52 | #include <linux/gfp.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 |  | 
|  | 54 | #include <asm/io.h> | 
|  | 55 | #include <asm/dma.h> | 
|  | 56 | #include <asm/byteorder.h> | 
|  | 57 |  | 
|  | 58 | #include <net/irda/irda.h> | 
|  | 59 | #include <net/irda/wrapper.h> | 
|  | 60 | #include <net/irda/irda_device.h> | 
|  | 61 | #include "w83977af.h" | 
|  | 62 | #include "w83977af_ir.h" | 
|  | 63 |  | 
|  | 64 | #ifdef  CONFIG_ARCH_NETWINDER            /* Adjust to NetWinder differences */ | 
|  | 65 | #undef  CONFIG_NETWINDER_TX_DMA_PROBLEMS /* Not needed */ | 
|  | 66 | #define CONFIG_NETWINDER_RX_DMA_PROBLEMS /* Must have this one! */ | 
|  | 67 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 68 | #define CONFIG_USE_W977_PNP        /* Currently needed */ | 
|  | 69 | #define PIO_MAX_SPEED       115200 | 
|  | 70 |  | 
|  | 71 | static char *driver_name = "w83977af_ir"; | 
|  | 72 | static int  qos_mtt_bits = 0x07;   /* 1 ms or more */ | 
|  | 73 |  | 
|  | 74 | #define CHIP_IO_EXTENT 8 | 
|  | 75 |  | 
|  | 76 | static unsigned int io[] = { 0x180, ~0, ~0, ~0 }; | 
|  | 77 | #ifdef CONFIG_ARCH_NETWINDER             /* Adjust to NetWinder differences */ | 
|  | 78 | static unsigned int irq[] = { 6, 0, 0, 0 }; | 
|  | 79 | #else | 
|  | 80 | static unsigned int irq[] = { 11, 0, 0, 0 }; | 
|  | 81 | #endif | 
|  | 82 | static unsigned int dma[] = { 1, 0, 0, 0 }; | 
|  | 83 | static unsigned int efbase[] = { W977_EFIO_BASE, W977_EFIO2_BASE }; | 
|  | 84 | static unsigned int efio = W977_EFIO_BASE; | 
|  | 85 |  | 
|  | 86 | static struct w83977af_ir *dev_self[] = { NULL, NULL, NULL, NULL}; | 
|  | 87 |  | 
|  | 88 | /* Some prototypes */ | 
|  | 89 | static int  w83977af_open(int i, unsigned int iobase, unsigned int irq, | 
|  | 90 | unsigned int dma); | 
|  | 91 | static int  w83977af_close(struct w83977af_ir *self); | 
|  | 92 | static int  w83977af_probe(int iobase, int irq, int dma); | 
|  | 93 | static int  w83977af_dma_receive(struct w83977af_ir *self); | 
|  | 94 | static int  w83977af_dma_receive_complete(struct w83977af_ir *self); | 
| Stephen Hemminger | 6518bbb | 2009-08-31 19:50:50 +0000 | [diff] [blame] | 95 | static netdev_tx_t  w83977af_hard_xmit(struct sk_buff *skb, | 
|  | 96 | struct net_device *dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 97 | static int  w83977af_pio_write(int iobase, __u8 *buf, int len, int fifo_size); | 
|  | 98 | static void w83977af_dma_write(struct w83977af_ir *self, int iobase); | 
|  | 99 | static void w83977af_change_speed(struct w83977af_ir *self, __u32 speed); | 
|  | 100 | static int  w83977af_is_receiving(struct w83977af_ir *self); | 
|  | 101 |  | 
|  | 102 | static int  w83977af_net_open(struct net_device *dev); | 
|  | 103 | static int  w83977af_net_close(struct net_device *dev); | 
|  | 104 | static int  w83977af_net_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 105 |  | 
|  | 106 | /* | 
|  | 107 | * Function w83977af_init () | 
|  | 108 | * | 
|  | 109 | *    Initialize chip. Just try to find out how many chips we are dealing with | 
|  | 110 | *    and where they are | 
|  | 111 | */ | 
|  | 112 | static int __init w83977af_init(void) | 
|  | 113 | { | 
|  | 114 | int i; | 
|  | 115 |  | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 116 | IRDA_DEBUG(0, "%s()\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 117 |  | 
| Roel Kluin | 5d5ceb8 | 2009-08-06 13:06:03 +0000 | [diff] [blame] | 118 | for (i=0; i < ARRAY_SIZE(dev_self) && io[i] < 2000; i++) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 119 | if (w83977af_open(i, io[i], irq[i], dma[i]) == 0) | 
|  | 120 | return 0; | 
|  | 121 | } | 
|  | 122 | return -ENODEV; | 
|  | 123 | } | 
|  | 124 |  | 
|  | 125 | /* | 
|  | 126 | * Function w83977af_cleanup () | 
|  | 127 | * | 
|  | 128 | *    Close all configured chips | 
|  | 129 | * | 
|  | 130 | */ | 
|  | 131 | static void __exit w83977af_cleanup(void) | 
|  | 132 | { | 
|  | 133 | int i; | 
|  | 134 |  | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 135 | IRDA_DEBUG(4, "%s()\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 136 |  | 
| Bjorn Helgaas | 9c3bd68 | 2006-08-15 00:05:38 -0700 | [diff] [blame] | 137 | for (i=0; i < ARRAY_SIZE(dev_self); i++) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 138 | if (dev_self[i]) | 
|  | 139 | w83977af_close(dev_self[i]); | 
|  | 140 | } | 
|  | 141 | } | 
|  | 142 |  | 
| Stephen Hemminger | 4113a1a | 2009-03-20 19:35:38 +0000 | [diff] [blame] | 143 | static const struct net_device_ops w83977_netdev_ops = { | 
|  | 144 | .ndo_open       = w83977af_net_open, | 
|  | 145 | .ndo_stop       = w83977af_net_close, | 
|  | 146 | .ndo_start_xmit = w83977af_hard_xmit, | 
|  | 147 | .ndo_do_ioctl   = w83977af_net_ioctl, | 
|  | 148 | }; | 
|  | 149 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 150 | /* | 
|  | 151 | * Function w83977af_open (iobase, irq) | 
|  | 152 | * | 
|  | 153 | *    Open driver instance | 
|  | 154 | * | 
|  | 155 | */ | 
| Hannes Eder | 0e49e64 | 2008-12-26 00:03:19 -0800 | [diff] [blame] | 156 | static int w83977af_open(int i, unsigned int iobase, unsigned int irq, | 
|  | 157 | unsigned int dma) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 158 | { | 
|  | 159 | struct net_device *dev; | 
|  | 160 | struct w83977af_ir *self; | 
|  | 161 | int err; | 
|  | 162 |  | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 163 | IRDA_DEBUG(0, "%s()\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 164 |  | 
|  | 165 | /* Lock the port that we need */ | 
|  | 166 | if (!request_region(iobase, CHIP_IO_EXTENT, driver_name)) { | 
|  | 167 | IRDA_DEBUG(0, "%s(), can't get iobase of 0x%03x\n", | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 168 | __func__ , iobase); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 169 | return -ENODEV; | 
|  | 170 | } | 
|  | 171 |  | 
|  | 172 | if (w83977af_probe(iobase, irq, dma) == -1) { | 
|  | 173 | err = -1; | 
|  | 174 | goto err_out; | 
|  | 175 | } | 
|  | 176 | /* | 
|  | 177 | *  Allocate new instance of the driver | 
|  | 178 | */ | 
|  | 179 | dev = alloc_irdadev(sizeof(struct w83977af_ir)); | 
|  | 180 | if (dev == NULL) { | 
|  | 181 | printk( KERN_ERR "IrDA: Can't allocate memory for " | 
|  | 182 | "IrDA control block!\n"); | 
|  | 183 | err = -ENOMEM; | 
|  | 184 | goto err_out; | 
|  | 185 | } | 
|  | 186 |  | 
| Wang Chen | 4cf1653 | 2008-11-12 23:38:14 -0800 | [diff] [blame] | 187 | self = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 188 | spin_lock_init(&self->lock); | 
|  | 189 |  | 
|  | 190 |  | 
|  | 191 | /* Initialize IO */ | 
|  | 192 | self->io.fir_base   = iobase; | 
|  | 193 | self->io.irq       = irq; | 
|  | 194 | self->io.fir_ext   = CHIP_IO_EXTENT; | 
|  | 195 | self->io.dma       = dma; | 
|  | 196 | self->io.fifo_size = 32; | 
|  | 197 |  | 
|  | 198 | /* Initialize QoS for this device */ | 
|  | 199 | irda_init_max_qos_capabilies(&self->qos); | 
|  | 200 |  | 
|  | 201 | /* The only value we must override it the baudrate */ | 
|  | 202 |  | 
|  | 203 | /* FIXME: The HP HDLS-1100 does not support 1152000! */ | 
|  | 204 | self->qos.baud_rate.bits = IR_9600|IR_19200|IR_38400|IR_57600| | 
|  | 205 | IR_115200|IR_576000|IR_1152000|(IR_4000000 << 8); | 
|  | 206 |  | 
|  | 207 | /* The HP HDLS-1100 needs 1 ms according to the specs */ | 
|  | 208 | self->qos.min_turn_time.bits = qos_mtt_bits; | 
|  | 209 | irda_qos_bits_to_value(&self->qos); | 
|  | 210 |  | 
|  | 211 | /* Max DMA buffer size needed = (data_size + 6) * (window_size) + 6; */ | 
|  | 212 | self->rx_buff.truesize = 14384; | 
|  | 213 | self->tx_buff.truesize = 4000; | 
|  | 214 |  | 
|  | 215 | /* Allocate memory if needed */ | 
|  | 216 | self->rx_buff.head = | 
|  | 217 | dma_alloc_coherent(NULL, self->rx_buff.truesize, | 
|  | 218 | &self->rx_buff_dma, GFP_KERNEL); | 
|  | 219 | if (self->rx_buff.head == NULL) { | 
|  | 220 | err = -ENOMEM; | 
|  | 221 | goto err_out1; | 
|  | 222 | } | 
|  | 223 |  | 
|  | 224 | memset(self->rx_buff.head, 0, self->rx_buff.truesize); | 
|  | 225 |  | 
|  | 226 | self->tx_buff.head = | 
|  | 227 | dma_alloc_coherent(NULL, self->tx_buff.truesize, | 
|  | 228 | &self->tx_buff_dma, GFP_KERNEL); | 
|  | 229 | if (self->tx_buff.head == NULL) { | 
|  | 230 | err = -ENOMEM; | 
|  | 231 | goto err_out2; | 
|  | 232 | } | 
|  | 233 | memset(self->tx_buff.head, 0, self->tx_buff.truesize); | 
|  | 234 |  | 
|  | 235 | self->rx_buff.in_frame = FALSE; | 
|  | 236 | self->rx_buff.state = OUTSIDE_FRAME; | 
|  | 237 | self->tx_buff.data = self->tx_buff.head; | 
|  | 238 | self->rx_buff.data = self->rx_buff.head; | 
|  | 239 | self->netdev = dev; | 
|  | 240 |  | 
| Stephen Hemminger | 4113a1a | 2009-03-20 19:35:38 +0000 | [diff] [blame] | 241 | dev->netdev_ops	= &w83977_netdev_ops; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 242 |  | 
|  | 243 | err = register_netdev(dev); | 
|  | 244 | if (err) { | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 245 | IRDA_ERROR("%s(), register_netdevice() failed!\n", __func__); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 246 | goto err_out3; | 
|  | 247 | } | 
|  | 248 | IRDA_MESSAGE("IrDA: Registered device %s\n", dev->name); | 
|  | 249 |  | 
|  | 250 | /* Need to store self somewhere */ | 
|  | 251 | dev_self[i] = self; | 
|  | 252 |  | 
|  | 253 | return 0; | 
|  | 254 | err_out3: | 
|  | 255 | dma_free_coherent(NULL, self->tx_buff.truesize, | 
|  | 256 | self->tx_buff.head, self->tx_buff_dma); | 
|  | 257 | err_out2: | 
|  | 258 | dma_free_coherent(NULL, self->rx_buff.truesize, | 
|  | 259 | self->rx_buff.head, self->rx_buff_dma); | 
|  | 260 | err_out1: | 
|  | 261 | free_netdev(dev); | 
|  | 262 | err_out: | 
|  | 263 | release_region(iobase, CHIP_IO_EXTENT); | 
|  | 264 | return err; | 
|  | 265 | } | 
|  | 266 |  | 
|  | 267 | /* | 
|  | 268 | * Function w83977af_close (self) | 
|  | 269 | * | 
|  | 270 | *    Close driver instance | 
|  | 271 | * | 
|  | 272 | */ | 
|  | 273 | static int w83977af_close(struct w83977af_ir *self) | 
|  | 274 | { | 
|  | 275 | int iobase; | 
|  | 276 |  | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 277 | IRDA_DEBUG(0, "%s()\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 278 |  | 
|  | 279 | iobase = self->io.fir_base; | 
|  | 280 |  | 
|  | 281 | #ifdef CONFIG_USE_W977_PNP | 
|  | 282 | /* enter PnP configuration mode */ | 
|  | 283 | w977_efm_enter(efio); | 
|  | 284 |  | 
|  | 285 | w977_select_device(W977_DEVICE_IR, efio); | 
|  | 286 |  | 
|  | 287 | /* Deactivate device */ | 
|  | 288 | w977_write_reg(0x30, 0x00, efio); | 
|  | 289 |  | 
|  | 290 | w977_efm_exit(efio); | 
|  | 291 | #endif /* CONFIG_USE_W977_PNP */ | 
|  | 292 |  | 
|  | 293 | /* Remove netdevice */ | 
|  | 294 | unregister_netdev(self->netdev); | 
|  | 295 |  | 
|  | 296 | /* Release the PORT that this driver is using */ | 
|  | 297 | IRDA_DEBUG(0 , "%s(), Releasing Region %03x\n", | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 298 | __func__ , self->io.fir_base); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 299 | release_region(self->io.fir_base, self->io.fir_ext); | 
|  | 300 |  | 
|  | 301 | if (self->tx_buff.head) | 
|  | 302 | dma_free_coherent(NULL, self->tx_buff.truesize, | 
|  | 303 | self->tx_buff.head, self->tx_buff_dma); | 
|  | 304 |  | 
|  | 305 | if (self->rx_buff.head) | 
|  | 306 | dma_free_coherent(NULL, self->rx_buff.truesize, | 
|  | 307 | self->rx_buff.head, self->rx_buff_dma); | 
|  | 308 |  | 
|  | 309 | free_netdev(self->netdev); | 
|  | 310 |  | 
|  | 311 | return 0; | 
|  | 312 | } | 
|  | 313 |  | 
| Hannes Eder | 0e49e64 | 2008-12-26 00:03:19 -0800 | [diff] [blame] | 314 | static int w83977af_probe(int iobase, int irq, int dma) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 315 | { | 
|  | 316 | int version; | 
|  | 317 | int i; | 
|  | 318 |  | 
|  | 319 | for (i=0; i < 2; i++) { | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 320 | IRDA_DEBUG( 0, "%s()\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 321 | #ifdef CONFIG_USE_W977_PNP | 
|  | 322 | /* Enter PnP configuration mode */ | 
|  | 323 | w977_efm_enter(efbase[i]); | 
|  | 324 |  | 
|  | 325 | w977_select_device(W977_DEVICE_IR, efbase[i]); | 
|  | 326 |  | 
|  | 327 | /* Configure PnP port, IRQ, and DMA channel */ | 
|  | 328 | w977_write_reg(0x60, (iobase >> 8) & 0xff, efbase[i]); | 
|  | 329 | w977_write_reg(0x61, (iobase) & 0xff, efbase[i]); | 
|  | 330 |  | 
|  | 331 | w977_write_reg(0x70, irq, efbase[i]); | 
|  | 332 | #ifdef CONFIG_ARCH_NETWINDER | 
|  | 333 | /* Netwinder uses 1 higher than Linux */ | 
|  | 334 | w977_write_reg(0x74, dma+1, efbase[i]); | 
|  | 335 | #else | 
|  | 336 | w977_write_reg(0x74, dma, efbase[i]); | 
|  | 337 | #endif /*CONFIG_ARCH_NETWINDER */ | 
|  | 338 | w977_write_reg(0x75, 0x04, efbase[i]);  /* Disable Tx DMA */ | 
|  | 339 |  | 
|  | 340 | /* Set append hardware CRC, enable IR bank selection */ | 
|  | 341 | w977_write_reg(0xf0, APEDCRC|ENBNKSEL, efbase[i]); | 
|  | 342 |  | 
|  | 343 | /* Activate device */ | 
|  | 344 | w977_write_reg(0x30, 0x01, efbase[i]); | 
|  | 345 |  | 
|  | 346 | w977_efm_exit(efbase[i]); | 
|  | 347 | #endif /* CONFIG_USE_W977_PNP */ | 
|  | 348 | /* Disable Advanced mode */ | 
|  | 349 | switch_bank(iobase, SET2); | 
|  | 350 | outb(iobase+2, 0x00); | 
|  | 351 |  | 
|  | 352 | /* Turn on UART (global) interrupts */ | 
|  | 353 | switch_bank(iobase, SET0); | 
|  | 354 | outb(HCR_EN_IRQ, iobase+HCR); | 
|  | 355 |  | 
|  | 356 | /* Switch to advanced mode */ | 
|  | 357 | switch_bank(iobase, SET2); | 
|  | 358 | outb(inb(iobase+ADCR1) | ADCR1_ADV_SL, iobase+ADCR1); | 
|  | 359 |  | 
|  | 360 | /* Set default IR-mode */ | 
|  | 361 | switch_bank(iobase, SET0); | 
|  | 362 | outb(HCR_SIR, iobase+HCR); | 
|  | 363 |  | 
|  | 364 | /* Read the Advanced IR ID */ | 
|  | 365 | switch_bank(iobase, SET3); | 
|  | 366 | version = inb(iobase+AUID); | 
|  | 367 |  | 
|  | 368 | /* Should be 0x1? */ | 
|  | 369 | if (0x10 == (version & 0xf0)) { | 
|  | 370 | efio = efbase[i]; | 
|  | 371 |  | 
|  | 372 | /* Set FIFO size to 32 */ | 
|  | 373 | switch_bank(iobase, SET2); | 
|  | 374 | outb(ADCR2_RXFS32|ADCR2_TXFS32, iobase+ADCR2); | 
|  | 375 |  | 
|  | 376 | /* Set FIFO threshold to TX17, RX16 */ | 
|  | 377 | switch_bank(iobase, SET0); | 
|  | 378 | outb(UFR_RXTL|UFR_TXTL|UFR_TXF_RST|UFR_RXF_RST| | 
|  | 379 | UFR_EN_FIFO,iobase+UFR); | 
|  | 380 |  | 
|  | 381 | /* Receiver frame length */ | 
|  | 382 | switch_bank(iobase, SET4); | 
|  | 383 | outb(2048 & 0xff, iobase+6); | 
|  | 384 | outb((2048 >> 8) & 0x1f, iobase+7); | 
|  | 385 |  | 
|  | 386 | /* | 
|  | 387 | * Init HP HSDL-1100 transceiver. | 
|  | 388 | * | 
|  | 389 | * Set IRX_MSL since we have 2 * receive paths IRRX, | 
|  | 390 | * and IRRXH. Clear IRSL0D since we want IRSL0 * to | 
|  | 391 | * be a input pin used for IRRXH | 
|  | 392 | * | 
|  | 393 | *   IRRX  pin 37 connected to receiver | 
|  | 394 | *   IRTX  pin 38 connected to transmitter | 
|  | 395 | *   FIRRX pin 39 connected to receiver      (IRSL0) | 
|  | 396 | *   CIRRX pin 40 connected to pin 37 | 
|  | 397 | */ | 
|  | 398 | switch_bank(iobase, SET7); | 
|  | 399 | outb(0x40, iobase+7); | 
|  | 400 |  | 
|  | 401 | IRDA_MESSAGE("W83977AF (IR) driver loaded. " | 
|  | 402 | "Version: 0x%02x\n", version); | 
|  | 403 |  | 
|  | 404 | return 0; | 
|  | 405 | } else { | 
|  | 406 | /* Try next extented function register address */ | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 407 | IRDA_DEBUG( 0, "%s(), Wrong chip version", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 408 | } | 
|  | 409 | } | 
|  | 410 | return -1; | 
|  | 411 | } | 
|  | 412 |  | 
| Hannes Eder | 0e49e64 | 2008-12-26 00:03:19 -0800 | [diff] [blame] | 413 | static void w83977af_change_speed(struct w83977af_ir *self, __u32 speed) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 414 | { | 
|  | 415 | int ir_mode = HCR_SIR; | 
|  | 416 | int iobase; | 
|  | 417 | __u8 set; | 
|  | 418 |  | 
|  | 419 | iobase = self->io.fir_base; | 
|  | 420 |  | 
|  | 421 | /* Update accounting for new speed */ | 
|  | 422 | self->io.speed = speed; | 
|  | 423 |  | 
|  | 424 | /* Save current bank */ | 
|  | 425 | set = inb(iobase+SSR); | 
|  | 426 |  | 
|  | 427 | /* Disable interrupts */ | 
|  | 428 | switch_bank(iobase, SET0); | 
|  | 429 | outb(0, iobase+ICR); | 
|  | 430 |  | 
|  | 431 | /* Select Set 2 */ | 
|  | 432 | switch_bank(iobase, SET2); | 
|  | 433 | outb(0x00, iobase+ABHL); | 
|  | 434 |  | 
|  | 435 | switch (speed) { | 
|  | 436 | case 9600:   outb(0x0c, iobase+ABLL); break; | 
|  | 437 | case 19200:  outb(0x06, iobase+ABLL); break; | 
|  | 438 | case 38400:  outb(0x03, iobase+ABLL); break; | 
|  | 439 | case 57600:  outb(0x02, iobase+ABLL); break; | 
|  | 440 | case 115200: outb(0x01, iobase+ABLL); break; | 
|  | 441 | case 576000: | 
|  | 442 | ir_mode = HCR_MIR_576; | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 443 | IRDA_DEBUG(0, "%s(), handling baud of 576000\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 444 | break; | 
|  | 445 | case 1152000: | 
|  | 446 | ir_mode = HCR_MIR_1152; | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 447 | IRDA_DEBUG(0, "%s(), handling baud of 1152000\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 448 | break; | 
|  | 449 | case 4000000: | 
|  | 450 | ir_mode = HCR_FIR; | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 451 | IRDA_DEBUG(0, "%s(), handling baud of 4000000\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 452 | break; | 
|  | 453 | default: | 
|  | 454 | ir_mode = HCR_FIR; | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 455 | IRDA_DEBUG(0, "%s(), unknown baud rate of %d\n", __func__ , speed); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 456 | break; | 
|  | 457 | } | 
|  | 458 |  | 
|  | 459 | /* Set speed mode */ | 
|  | 460 | switch_bank(iobase, SET0); | 
|  | 461 | outb(ir_mode, iobase+HCR); | 
|  | 462 |  | 
|  | 463 | /* set FIFO size to 32 */ | 
|  | 464 | switch_bank(iobase, SET2); | 
|  | 465 | outb(ADCR2_RXFS32|ADCR2_TXFS32, iobase+ADCR2); | 
|  | 466 |  | 
|  | 467 | /* set FIFO threshold to TX17, RX16 */ | 
|  | 468 | switch_bank(iobase, SET0); | 
|  | 469 | outb(0x00, iobase+UFR);        /* Reset */ | 
|  | 470 | outb(UFR_EN_FIFO, iobase+UFR); /* First we must enable FIFO */ | 
|  | 471 | outb(0xa7, iobase+UFR); | 
|  | 472 |  | 
|  | 473 | netif_wake_queue(self->netdev); | 
|  | 474 |  | 
|  | 475 | /* Enable some interrupts so we can receive frames */ | 
|  | 476 | switch_bank(iobase, SET0); | 
|  | 477 | if (speed > PIO_MAX_SPEED) { | 
|  | 478 | outb(ICR_EFSFI, iobase+ICR); | 
|  | 479 | w83977af_dma_receive(self); | 
|  | 480 | } else | 
|  | 481 | outb(ICR_ERBRI, iobase+ICR); | 
|  | 482 |  | 
|  | 483 | /* Restore SSR */ | 
|  | 484 | outb(set, iobase+SSR); | 
|  | 485 | } | 
|  | 486 |  | 
|  | 487 | /* | 
|  | 488 | * Function w83977af_hard_xmit (skb, dev) | 
|  | 489 | * | 
|  | 490 | *    Sets up a DMA transfer to send the current frame. | 
|  | 491 | * | 
|  | 492 | */ | 
| Stephen Hemminger | 6518bbb | 2009-08-31 19:50:50 +0000 | [diff] [blame] | 493 | static netdev_tx_t w83977af_hard_xmit(struct sk_buff *skb, | 
|  | 494 | struct net_device *dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 495 | { | 
|  | 496 | struct w83977af_ir *self; | 
|  | 497 | __s32 speed; | 
|  | 498 | int iobase; | 
|  | 499 | __u8 set; | 
|  | 500 | int mtt; | 
|  | 501 |  | 
| Wang Chen | 4cf1653 | 2008-11-12 23:38:14 -0800 | [diff] [blame] | 502 | self = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 503 |  | 
|  | 504 | iobase = self->io.fir_base; | 
|  | 505 |  | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 506 | IRDA_DEBUG(4, "%s(%ld), skb->len=%d\n", __func__ , jiffies, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 507 | (int) skb->len); | 
|  | 508 |  | 
|  | 509 | /* Lock transmit buffer */ | 
|  | 510 | netif_stop_queue(dev); | 
|  | 511 |  | 
|  | 512 | /* Check if we need to change the speed */ | 
|  | 513 | speed = irda_get_next_speed(skb); | 
|  | 514 | if ((speed != self->io.speed) && (speed != -1)) { | 
|  | 515 | /* Check for empty frame */ | 
|  | 516 | if (!skb->len) { | 
|  | 517 | w83977af_change_speed(self, speed); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 518 | dev_kfree_skb(skb); | 
| Patrick McHardy | 6ed1065 | 2009-06-23 06:03:08 +0000 | [diff] [blame] | 519 | return NETDEV_TX_OK; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 520 | } else | 
|  | 521 | self->new_speed = speed; | 
|  | 522 | } | 
|  | 523 |  | 
|  | 524 | /* Save current set */ | 
|  | 525 | set = inb(iobase+SSR); | 
|  | 526 |  | 
|  | 527 | /* Decide if we should use PIO or DMA transfer */ | 
|  | 528 | if (self->io.speed > PIO_MAX_SPEED) { | 
|  | 529 | self->tx_buff.data = self->tx_buff.head; | 
| Arnaldo Carvalho de Melo | d626f62 | 2007-03-27 18:55:52 -0300 | [diff] [blame] | 530 | skb_copy_from_linear_data(skb, self->tx_buff.data, skb->len); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 531 | self->tx_buff.len = skb->len; | 
|  | 532 |  | 
|  | 533 | mtt = irda_get_mtt(skb); | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 534 | IRDA_DEBUG(4, "%s(%ld), mtt=%d\n", __func__ , jiffies, mtt); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 535 | if (mtt) | 
|  | 536 | udelay(mtt); | 
|  | 537 |  | 
|  | 538 | /* Enable DMA interrupt */ | 
|  | 539 | switch_bank(iobase, SET0); | 
|  | 540 | outb(ICR_EDMAI, iobase+ICR); | 
|  | 541 | w83977af_dma_write(self, iobase); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 542 | } else { | 
|  | 543 | self->tx_buff.data = self->tx_buff.head; | 
|  | 544 | self->tx_buff.len = async_wrap_skb(skb, self->tx_buff.data, | 
|  | 545 | self->tx_buff.truesize); | 
|  | 546 |  | 
|  | 547 | /* Add interrupt on tx low level (will fire immediately) */ | 
|  | 548 | switch_bank(iobase, SET0); | 
|  | 549 | outb(ICR_ETXTHI, iobase+ICR); | 
|  | 550 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 551 | dev_kfree_skb(skb); | 
|  | 552 |  | 
|  | 553 | /* Restore set register */ | 
|  | 554 | outb(set, iobase+SSR); | 
|  | 555 |  | 
| Patrick McHardy | 6ed1065 | 2009-06-23 06:03:08 +0000 | [diff] [blame] | 556 | return NETDEV_TX_OK; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 557 | } | 
|  | 558 |  | 
|  | 559 | /* | 
|  | 560 | * Function w83977af_dma_write (self, iobase) | 
|  | 561 | * | 
|  | 562 | *    Send frame using DMA | 
|  | 563 | * | 
|  | 564 | */ | 
|  | 565 | static void w83977af_dma_write(struct w83977af_ir *self, int iobase) | 
|  | 566 | { | 
|  | 567 | __u8 set; | 
|  | 568 | #ifdef CONFIG_NETWINDER_TX_DMA_PROBLEMS | 
|  | 569 | unsigned long flags; | 
|  | 570 | __u8 hcr; | 
|  | 571 | #endif | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 572 | IRDA_DEBUG(4, "%s(), len=%d\n", __func__ , self->tx_buff.len); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 573 |  | 
|  | 574 | /* Save current set */ | 
|  | 575 | set = inb(iobase+SSR); | 
|  | 576 |  | 
|  | 577 | /* Disable DMA */ | 
|  | 578 | switch_bank(iobase, SET0); | 
|  | 579 | outb(inb(iobase+HCR) & ~HCR_EN_DMA, iobase+HCR); | 
|  | 580 |  | 
|  | 581 | /* Choose transmit DMA channel  */ | 
|  | 582 | switch_bank(iobase, SET2); | 
|  | 583 | outb(ADCR1_D_CHSW|/*ADCR1_DMA_F|*/ADCR1_ADV_SL, iobase+ADCR1); | 
|  | 584 | #ifdef CONFIG_NETWINDER_TX_DMA_PROBLEMS | 
|  | 585 | spin_lock_irqsave(&self->lock, flags); | 
|  | 586 |  | 
|  | 587 | disable_dma(self->io.dma); | 
|  | 588 | clear_dma_ff(self->io.dma); | 
|  | 589 | set_dma_mode(self->io.dma, DMA_MODE_READ); | 
|  | 590 | set_dma_addr(self->io.dma, self->tx_buff_dma); | 
|  | 591 | set_dma_count(self->io.dma, self->tx_buff.len); | 
|  | 592 | #else | 
|  | 593 | irda_setup_dma(self->io.dma, self->tx_buff_dma, self->tx_buff.len, | 
|  | 594 | DMA_MODE_WRITE); | 
|  | 595 | #endif | 
|  | 596 | self->io.direction = IO_XMIT; | 
|  | 597 |  | 
|  | 598 | /* Enable DMA */ | 
|  | 599 | switch_bank(iobase, SET0); | 
|  | 600 | #ifdef CONFIG_NETWINDER_TX_DMA_PROBLEMS | 
|  | 601 | hcr = inb(iobase+HCR); | 
|  | 602 | outb(hcr | HCR_EN_DMA, iobase+HCR); | 
|  | 603 | enable_dma(self->io.dma); | 
|  | 604 | spin_unlock_irqrestore(&self->lock, flags); | 
|  | 605 | #else | 
|  | 606 | outb(inb(iobase+HCR) | HCR_EN_DMA | HCR_TX_WT, iobase+HCR); | 
|  | 607 | #endif | 
|  | 608 |  | 
|  | 609 | /* Restore set register */ | 
|  | 610 | outb(set, iobase+SSR); | 
|  | 611 | } | 
|  | 612 |  | 
|  | 613 | /* | 
|  | 614 | * Function w83977af_pio_write (iobase, buf, len, fifo_size) | 
|  | 615 | * | 
|  | 616 | * | 
|  | 617 | * | 
|  | 618 | */ | 
|  | 619 | static int w83977af_pio_write(int iobase, __u8 *buf, int len, int fifo_size) | 
|  | 620 | { | 
|  | 621 | int actual = 0; | 
|  | 622 | __u8 set; | 
|  | 623 |  | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 624 | IRDA_DEBUG(4, "%s()\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 625 |  | 
|  | 626 | /* Save current bank */ | 
|  | 627 | set = inb(iobase+SSR); | 
|  | 628 |  | 
|  | 629 | switch_bank(iobase, SET0); | 
|  | 630 | if (!(inb_p(iobase+USR) & USR_TSRE)) { | 
|  | 631 | IRDA_DEBUG(4, | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 632 | "%s(), warning, FIFO not empty yet!\n", __func__  ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 633 |  | 
|  | 634 | fifo_size -= 17; | 
|  | 635 | IRDA_DEBUG(4, "%s(), %d bytes left in tx fifo\n", | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 636 | __func__ , fifo_size); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 637 | } | 
|  | 638 |  | 
|  | 639 | /* Fill FIFO with current frame */ | 
|  | 640 | while ((fifo_size-- > 0) && (actual < len)) { | 
|  | 641 | /* Transmit next byte */ | 
|  | 642 | outb(buf[actual++], iobase+TBR); | 
|  | 643 | } | 
|  | 644 |  | 
|  | 645 | IRDA_DEBUG(4, "%s(), fifo_size %d ; %d sent of %d\n", | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 646 | __func__ , fifo_size, actual, len); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 647 |  | 
|  | 648 | /* Restore bank */ | 
|  | 649 | outb(set, iobase+SSR); | 
|  | 650 |  | 
|  | 651 | return actual; | 
|  | 652 | } | 
|  | 653 |  | 
|  | 654 | /* | 
|  | 655 | * Function w83977af_dma_xmit_complete (self) | 
|  | 656 | * | 
|  | 657 | *    The transfer of a frame in finished. So do the necessary things | 
|  | 658 | * | 
|  | 659 | * | 
|  | 660 | */ | 
|  | 661 | static void w83977af_dma_xmit_complete(struct w83977af_ir *self) | 
|  | 662 | { | 
|  | 663 | int iobase; | 
|  | 664 | __u8 set; | 
|  | 665 |  | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 666 | IRDA_DEBUG(4, "%s(%ld)\n", __func__ , jiffies); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 667 |  | 
|  | 668 | IRDA_ASSERT(self != NULL, return;); | 
|  | 669 |  | 
|  | 670 | iobase = self->io.fir_base; | 
|  | 671 |  | 
|  | 672 | /* Save current set */ | 
|  | 673 | set = inb(iobase+SSR); | 
|  | 674 |  | 
|  | 675 | /* Disable DMA */ | 
|  | 676 | switch_bank(iobase, SET0); | 
|  | 677 | outb(inb(iobase+HCR) & ~HCR_EN_DMA, iobase+HCR); | 
|  | 678 |  | 
|  | 679 | /* Check for underrrun! */ | 
|  | 680 | if (inb(iobase+AUDR) & AUDR_UNDR) { | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 681 | IRDA_DEBUG(0, "%s(), Transmit underrun!\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 682 |  | 
| Stephen Hemminger | af04908 | 2009-01-06 10:40:43 -0800 | [diff] [blame] | 683 | self->netdev->stats.tx_errors++; | 
|  | 684 | self->netdev->stats.tx_fifo_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 685 |  | 
|  | 686 | /* Clear bit, by writing 1 to it */ | 
|  | 687 | outb(AUDR_UNDR, iobase+AUDR); | 
|  | 688 | } else | 
| Stephen Hemminger | af04908 | 2009-01-06 10:40:43 -0800 | [diff] [blame] | 689 | self->netdev->stats.tx_packets++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 690 |  | 
|  | 691 |  | 
|  | 692 | if (self->new_speed) { | 
|  | 693 | w83977af_change_speed(self, self->new_speed); | 
|  | 694 | self->new_speed = 0; | 
|  | 695 | } | 
|  | 696 |  | 
|  | 697 | /* Unlock tx_buff and request another frame */ | 
|  | 698 | /* Tell the network layer, that we want more frames */ | 
|  | 699 | netif_wake_queue(self->netdev); | 
|  | 700 |  | 
|  | 701 | /* Restore set */ | 
|  | 702 | outb(set, iobase+SSR); | 
|  | 703 | } | 
|  | 704 |  | 
|  | 705 | /* | 
|  | 706 | * Function w83977af_dma_receive (self) | 
|  | 707 | * | 
|  | 708 | *    Get ready for receiving a frame. The device will initiate a DMA | 
|  | 709 | *    if it starts to receive a frame. | 
|  | 710 | * | 
|  | 711 | */ | 
| Hannes Eder | 0e49e64 | 2008-12-26 00:03:19 -0800 | [diff] [blame] | 712 | static int w83977af_dma_receive(struct w83977af_ir *self) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 713 | { | 
|  | 714 | int iobase; | 
|  | 715 | __u8 set; | 
|  | 716 | #ifdef CONFIG_NETWINDER_RX_DMA_PROBLEMS | 
|  | 717 | unsigned long flags; | 
|  | 718 | __u8 hcr; | 
|  | 719 | #endif | 
|  | 720 | IRDA_ASSERT(self != NULL, return -1;); | 
|  | 721 |  | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 722 | IRDA_DEBUG(4, "%s\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 723 |  | 
|  | 724 | iobase= self->io.fir_base; | 
|  | 725 |  | 
|  | 726 | /* Save current set */ | 
|  | 727 | set = inb(iobase+SSR); | 
|  | 728 |  | 
|  | 729 | /* Disable DMA */ | 
|  | 730 | switch_bank(iobase, SET0); | 
|  | 731 | outb(inb(iobase+HCR) & ~HCR_EN_DMA, iobase+HCR); | 
|  | 732 |  | 
|  | 733 | /* Choose DMA Rx, DMA Fairness, and Advanced mode */ | 
|  | 734 | switch_bank(iobase, SET2); | 
|  | 735 | outb((inb(iobase+ADCR1) & ~ADCR1_D_CHSW)/*|ADCR1_DMA_F*/|ADCR1_ADV_SL, | 
|  | 736 | iobase+ADCR1); | 
|  | 737 |  | 
|  | 738 | self->io.direction = IO_RECV; | 
|  | 739 | self->rx_buff.data = self->rx_buff.head; | 
|  | 740 |  | 
|  | 741 | #ifdef CONFIG_NETWINDER_RX_DMA_PROBLEMS | 
|  | 742 | spin_lock_irqsave(&self->lock, flags); | 
|  | 743 |  | 
|  | 744 | disable_dma(self->io.dma); | 
|  | 745 | clear_dma_ff(self->io.dma); | 
|  | 746 | set_dma_mode(self->io.dma, DMA_MODE_READ); | 
|  | 747 | set_dma_addr(self->io.dma, self->rx_buff_dma); | 
|  | 748 | set_dma_count(self->io.dma, self->rx_buff.truesize); | 
|  | 749 | #else | 
|  | 750 | irda_setup_dma(self->io.dma, self->rx_buff_dma, self->rx_buff.truesize, | 
|  | 751 | DMA_MODE_READ); | 
|  | 752 | #endif | 
|  | 753 | /* | 
|  | 754 | * Reset Rx FIFO. This will also flush the ST_FIFO, it's very | 
|  | 755 | * important that we don't reset the Tx FIFO since it might not | 
|  | 756 | * be finished transmitting yet | 
|  | 757 | */ | 
|  | 758 | switch_bank(iobase, SET0); | 
|  | 759 | outb(UFR_RXTL|UFR_TXTL|UFR_RXF_RST|UFR_EN_FIFO, iobase+UFR); | 
|  | 760 | self->st_fifo.len = self->st_fifo.tail = self->st_fifo.head = 0; | 
|  | 761 |  | 
|  | 762 | /* Enable DMA */ | 
|  | 763 | switch_bank(iobase, SET0); | 
|  | 764 | #ifdef CONFIG_NETWINDER_RX_DMA_PROBLEMS | 
|  | 765 | hcr = inb(iobase+HCR); | 
|  | 766 | outb(hcr | HCR_EN_DMA, iobase+HCR); | 
|  | 767 | enable_dma(self->io.dma); | 
|  | 768 | spin_unlock_irqrestore(&self->lock, flags); | 
|  | 769 | #else | 
|  | 770 | outb(inb(iobase+HCR) | HCR_EN_DMA, iobase+HCR); | 
|  | 771 | #endif | 
|  | 772 | /* Restore set */ | 
|  | 773 | outb(set, iobase+SSR); | 
|  | 774 |  | 
|  | 775 | return 0; | 
|  | 776 | } | 
|  | 777 |  | 
|  | 778 | /* | 
|  | 779 | * Function w83977af_receive_complete (self) | 
|  | 780 | * | 
|  | 781 | *    Finished with receiving a frame | 
|  | 782 | * | 
|  | 783 | */ | 
| Hannes Eder | 0e49e64 | 2008-12-26 00:03:19 -0800 | [diff] [blame] | 784 | static int w83977af_dma_receive_complete(struct w83977af_ir *self) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 785 | { | 
|  | 786 | struct sk_buff *skb; | 
|  | 787 | struct st_fifo *st_fifo; | 
|  | 788 | int len; | 
|  | 789 | int iobase; | 
|  | 790 | __u8 set; | 
|  | 791 | __u8 status; | 
|  | 792 |  | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 793 | IRDA_DEBUG(4, "%s\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 794 |  | 
|  | 795 | st_fifo = &self->st_fifo; | 
|  | 796 |  | 
|  | 797 | iobase = self->io.fir_base; | 
|  | 798 |  | 
|  | 799 | /* Save current set */ | 
|  | 800 | set = inb(iobase+SSR); | 
|  | 801 |  | 
|  | 802 | iobase = self->io.fir_base; | 
|  | 803 |  | 
|  | 804 | /* Read status FIFO */ | 
|  | 805 | switch_bank(iobase, SET5); | 
|  | 806 | while ((status = inb(iobase+FS_FO)) & FS_FO_FSFDR) { | 
|  | 807 | st_fifo->entries[st_fifo->tail].status = status; | 
|  | 808 |  | 
|  | 809 | st_fifo->entries[st_fifo->tail].len  = inb(iobase+RFLFL); | 
|  | 810 | st_fifo->entries[st_fifo->tail].len |= inb(iobase+RFLFH) << 8; | 
|  | 811 |  | 
|  | 812 | st_fifo->tail++; | 
|  | 813 | st_fifo->len++; | 
|  | 814 | } | 
|  | 815 |  | 
|  | 816 | while (st_fifo->len) { | 
|  | 817 | /* Get first entry */ | 
|  | 818 | status = st_fifo->entries[st_fifo->head].status; | 
|  | 819 | len    = st_fifo->entries[st_fifo->head].len; | 
|  | 820 | st_fifo->head++; | 
|  | 821 | st_fifo->len--; | 
|  | 822 |  | 
|  | 823 | /* Check for errors */ | 
|  | 824 | if (status & FS_FO_ERR_MSK) { | 
|  | 825 | if (status & FS_FO_LST_FR) { | 
|  | 826 | /* Add number of lost frames to stats */ | 
| Stephen Hemminger | af04908 | 2009-01-06 10:40:43 -0800 | [diff] [blame] | 827 | self->netdev->stats.rx_errors += len; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 828 | } else { | 
|  | 829 | /* Skip frame */ | 
| Stephen Hemminger | af04908 | 2009-01-06 10:40:43 -0800 | [diff] [blame] | 830 | self->netdev->stats.rx_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 831 |  | 
|  | 832 | self->rx_buff.data += len; | 
|  | 833 |  | 
|  | 834 | if (status & FS_FO_MX_LEX) | 
| Stephen Hemminger | af04908 | 2009-01-06 10:40:43 -0800 | [diff] [blame] | 835 | self->netdev->stats.rx_length_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 836 |  | 
|  | 837 | if (status & FS_FO_PHY_ERR) | 
| Stephen Hemminger | af04908 | 2009-01-06 10:40:43 -0800 | [diff] [blame] | 838 | self->netdev->stats.rx_frame_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 839 |  | 
|  | 840 | if (status & FS_FO_CRC_ERR) | 
| Stephen Hemminger | af04908 | 2009-01-06 10:40:43 -0800 | [diff] [blame] | 841 | self->netdev->stats.rx_crc_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 842 | } | 
|  | 843 | /* The errors below can be reported in both cases */ | 
|  | 844 | if (status & FS_FO_RX_OV) | 
| Stephen Hemminger | af04908 | 2009-01-06 10:40:43 -0800 | [diff] [blame] | 845 | self->netdev->stats.rx_fifo_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 846 |  | 
|  | 847 | if (status & FS_FO_FSF_OV) | 
| Stephen Hemminger | af04908 | 2009-01-06 10:40:43 -0800 | [diff] [blame] | 848 | self->netdev->stats.rx_fifo_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 849 |  | 
|  | 850 | } else { | 
|  | 851 | /* Check if we have transferred all data to memory */ | 
|  | 852 | switch_bank(iobase, SET0); | 
|  | 853 | if (inb(iobase+USR) & USR_RDR) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 854 | udelay(80); /* Should be enough!? */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 855 | } | 
|  | 856 |  | 
|  | 857 | skb = dev_alloc_skb(len+1); | 
|  | 858 | if (skb == NULL)  { | 
|  | 859 | printk(KERN_INFO | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 860 | "%s(), memory squeeze, dropping frame.\n", __func__); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 861 | /* Restore set register */ | 
|  | 862 | outb(set, iobase+SSR); | 
|  | 863 |  | 
|  | 864 | return FALSE; | 
|  | 865 | } | 
|  | 866 |  | 
|  | 867 | /*  Align to 20 bytes */ | 
|  | 868 | skb_reserve(skb, 1); | 
|  | 869 |  | 
|  | 870 | /* Copy frame without CRC */ | 
|  | 871 | if (self->io.speed < 4000000) { | 
|  | 872 | skb_put(skb, len-2); | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 873 | skb_copy_to_linear_data(skb, | 
|  | 874 | self->rx_buff.data, | 
|  | 875 | len - 2); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 876 | } else { | 
|  | 877 | skb_put(skb, len-4); | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 878 | skb_copy_to_linear_data(skb, | 
|  | 879 | self->rx_buff.data, | 
|  | 880 | len - 4); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 881 | } | 
|  | 882 |  | 
|  | 883 | /* Move to next frame */ | 
|  | 884 | self->rx_buff.data += len; | 
| Stephen Hemminger | af04908 | 2009-01-06 10:40:43 -0800 | [diff] [blame] | 885 | self->netdev->stats.rx_packets++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 886 |  | 
|  | 887 | skb->dev = self->netdev; | 
| Arnaldo Carvalho de Melo | 459a98e | 2007-03-19 15:30:44 -0700 | [diff] [blame] | 888 | skb_reset_mac_header(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 889 | skb->protocol = htons(ETH_P_IRDA); | 
|  | 890 | netif_rx(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 891 | } | 
|  | 892 | } | 
|  | 893 | /* Restore set register */ | 
|  | 894 | outb(set, iobase+SSR); | 
|  | 895 |  | 
|  | 896 | return TRUE; | 
|  | 897 | } | 
|  | 898 |  | 
|  | 899 | /* | 
|  | 900 | * Function pc87108_pio_receive (self) | 
|  | 901 | * | 
|  | 902 | *    Receive all data in receiver FIFO | 
|  | 903 | * | 
|  | 904 | */ | 
|  | 905 | static void w83977af_pio_receive(struct w83977af_ir *self) | 
|  | 906 | { | 
|  | 907 | __u8 byte = 0x00; | 
|  | 908 | int iobase; | 
|  | 909 |  | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 910 | IRDA_DEBUG(4, "%s()\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 911 |  | 
|  | 912 | IRDA_ASSERT(self != NULL, return;); | 
|  | 913 |  | 
|  | 914 | iobase = self->io.fir_base; | 
|  | 915 |  | 
|  | 916 | /*  Receive all characters in Rx FIFO */ | 
|  | 917 | do { | 
|  | 918 | byte = inb(iobase+RBR); | 
| Stephen Hemminger | af04908 | 2009-01-06 10:40:43 -0800 | [diff] [blame] | 919 | async_unwrap_char(self->netdev, &self->netdev->stats, &self->rx_buff, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 920 | byte); | 
|  | 921 | } while (inb(iobase+USR) & USR_RDR); /* Data available */ | 
|  | 922 | } | 
|  | 923 |  | 
|  | 924 | /* | 
|  | 925 | * Function w83977af_sir_interrupt (self, eir) | 
|  | 926 | * | 
|  | 927 | *    Handle SIR interrupt | 
|  | 928 | * | 
|  | 929 | */ | 
|  | 930 | static __u8 w83977af_sir_interrupt(struct w83977af_ir *self, int isr) | 
|  | 931 | { | 
|  | 932 | int actual; | 
|  | 933 | __u8 new_icr = 0; | 
|  | 934 | __u8 set; | 
|  | 935 | int iobase; | 
|  | 936 |  | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 937 | IRDA_DEBUG(4, "%s(), isr=%#x\n", __func__ , isr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 938 |  | 
|  | 939 | iobase = self->io.fir_base; | 
|  | 940 | /* Transmit FIFO low on data */ | 
|  | 941 | if (isr & ISR_TXTH_I) { | 
|  | 942 | /* Write data left in transmit buffer */ | 
|  | 943 | actual = w83977af_pio_write(self->io.fir_base, | 
|  | 944 | self->tx_buff.data, | 
|  | 945 | self->tx_buff.len, | 
|  | 946 | self->io.fifo_size); | 
|  | 947 |  | 
|  | 948 | self->tx_buff.data += actual; | 
|  | 949 | self->tx_buff.len  -= actual; | 
|  | 950 |  | 
|  | 951 | self->io.direction = IO_XMIT; | 
|  | 952 |  | 
|  | 953 | /* Check if finished */ | 
|  | 954 | if (self->tx_buff.len > 0) { | 
|  | 955 | new_icr |= ICR_ETXTHI; | 
|  | 956 | } else { | 
|  | 957 | set = inb(iobase+SSR); | 
|  | 958 | switch_bank(iobase, SET0); | 
|  | 959 | outb(AUDR_SFEND, iobase+AUDR); | 
|  | 960 | outb(set, iobase+SSR); | 
|  | 961 |  | 
| Stephen Hemminger | af04908 | 2009-01-06 10:40:43 -0800 | [diff] [blame] | 962 | self->netdev->stats.tx_packets++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 963 |  | 
|  | 964 | /* Feed me more packets */ | 
|  | 965 | netif_wake_queue(self->netdev); | 
|  | 966 | new_icr |= ICR_ETBREI; | 
|  | 967 | } | 
|  | 968 | } | 
|  | 969 | /* Check if transmission has completed */ | 
|  | 970 | if (isr & ISR_TXEMP_I) { | 
|  | 971 | /* Check if we need to change the speed? */ | 
|  | 972 | if (self->new_speed) { | 
|  | 973 | IRDA_DEBUG(2, | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 974 | "%s(), Changing speed!\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 975 | w83977af_change_speed(self, self->new_speed); | 
|  | 976 | self->new_speed = 0; | 
|  | 977 | } | 
|  | 978 |  | 
|  | 979 | /* Turn around and get ready to receive some data */ | 
|  | 980 | self->io.direction = IO_RECV; | 
|  | 981 | new_icr |= ICR_ERBRI; | 
|  | 982 | } | 
|  | 983 |  | 
|  | 984 | /* Rx FIFO threshold or timeout */ | 
|  | 985 | if (isr & ISR_RXTH_I) { | 
|  | 986 | w83977af_pio_receive(self); | 
|  | 987 |  | 
|  | 988 | /* Keep receiving */ | 
|  | 989 | new_icr |= ICR_ERBRI; | 
|  | 990 | } | 
|  | 991 | return new_icr; | 
|  | 992 | } | 
|  | 993 |  | 
|  | 994 | /* | 
|  | 995 | * Function pc87108_fir_interrupt (self, eir) | 
|  | 996 | * | 
|  | 997 | *    Handle MIR/FIR interrupt | 
|  | 998 | * | 
|  | 999 | */ | 
|  | 1000 | static __u8 w83977af_fir_interrupt(struct w83977af_ir *self, int isr) | 
|  | 1001 | { | 
|  | 1002 | __u8 new_icr = 0; | 
|  | 1003 | __u8 set; | 
|  | 1004 | int iobase; | 
|  | 1005 |  | 
|  | 1006 | iobase = self->io.fir_base; | 
|  | 1007 | set = inb(iobase+SSR); | 
|  | 1008 |  | 
|  | 1009 | /* End of frame detected in FIFO */ | 
|  | 1010 | if (isr & (ISR_FEND_I|ISR_FSF_I)) { | 
|  | 1011 | if (w83977af_dma_receive_complete(self)) { | 
|  | 1012 |  | 
|  | 1013 | /* Wait for next status FIFO interrupt */ | 
|  | 1014 | new_icr |= ICR_EFSFI; | 
|  | 1015 | } else { | 
|  | 1016 | /* DMA not finished yet */ | 
|  | 1017 |  | 
|  | 1018 | /* Set timer value, resolution 1 ms */ | 
|  | 1019 | switch_bank(iobase, SET4); | 
|  | 1020 | outb(0x01, iobase+TMRL); /* 1 ms */ | 
|  | 1021 | outb(0x00, iobase+TMRH); | 
|  | 1022 |  | 
|  | 1023 | /* Start timer */ | 
|  | 1024 | outb(IR_MSL_EN_TMR, iobase+IR_MSL); | 
|  | 1025 |  | 
|  | 1026 | new_icr |= ICR_ETMRI; | 
|  | 1027 | } | 
|  | 1028 | } | 
|  | 1029 | /* Timer finished */ | 
|  | 1030 | if (isr & ISR_TMR_I) { | 
|  | 1031 | /* Disable timer */ | 
|  | 1032 | switch_bank(iobase, SET4); | 
|  | 1033 | outb(0, iobase+IR_MSL); | 
|  | 1034 |  | 
|  | 1035 | /* Clear timer event */ | 
|  | 1036 | /* switch_bank(iobase, SET0); */ | 
|  | 1037 | /* 		outb(ASCR_CTE, iobase+ASCR); */ | 
|  | 1038 |  | 
|  | 1039 | /* Check if this is a TX timer interrupt */ | 
|  | 1040 | if (self->io.direction == IO_XMIT) { | 
|  | 1041 | w83977af_dma_write(self, iobase); | 
|  | 1042 |  | 
|  | 1043 | new_icr |= ICR_EDMAI; | 
|  | 1044 | } else { | 
|  | 1045 | /* Check if DMA has now finished */ | 
|  | 1046 | w83977af_dma_receive_complete(self); | 
|  | 1047 |  | 
|  | 1048 | new_icr |= ICR_EFSFI; | 
|  | 1049 | } | 
|  | 1050 | } | 
|  | 1051 | /* Finished with DMA */ | 
|  | 1052 | if (isr & ISR_DMA_I) { | 
|  | 1053 | w83977af_dma_xmit_complete(self); | 
|  | 1054 |  | 
|  | 1055 | /* Check if there are more frames to be transmitted */ | 
|  | 1056 | /* if (irda_device_txqueue_empty(self)) { */ | 
|  | 1057 |  | 
|  | 1058 | /* Prepare for receive | 
|  | 1059 | * | 
|  | 1060 | * ** Netwinder Tx DMA likes that we do this anyway ** | 
|  | 1061 | */ | 
|  | 1062 | w83977af_dma_receive(self); | 
|  | 1063 | new_icr = ICR_EFSFI; | 
|  | 1064 | /* } */ | 
|  | 1065 | } | 
|  | 1066 |  | 
|  | 1067 | /* Restore set */ | 
|  | 1068 | outb(set, iobase+SSR); | 
|  | 1069 |  | 
|  | 1070 | return new_icr; | 
|  | 1071 | } | 
|  | 1072 |  | 
|  | 1073 | /* | 
|  | 1074 | * Function w83977af_interrupt (irq, dev_id, regs) | 
|  | 1075 | * | 
|  | 1076 | *    An interrupt from the chip has arrived. Time to do some work | 
|  | 1077 | * | 
|  | 1078 | */ | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 1079 | static irqreturn_t w83977af_interrupt(int irq, void *dev_id) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1080 | { | 
| Jeff Garzik | c31f28e | 2006-10-06 14:56:04 -0400 | [diff] [blame] | 1081 | struct net_device *dev = dev_id; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1082 | struct w83977af_ir *self; | 
|  | 1083 | __u8 set, icr, isr; | 
|  | 1084 | int iobase; | 
|  | 1085 |  | 
| Wang Chen | 4cf1653 | 2008-11-12 23:38:14 -0800 | [diff] [blame] | 1086 | self = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1087 |  | 
|  | 1088 | iobase = self->io.fir_base; | 
|  | 1089 |  | 
|  | 1090 | /* Save current bank */ | 
|  | 1091 | set = inb(iobase+SSR); | 
|  | 1092 | switch_bank(iobase, SET0); | 
|  | 1093 |  | 
|  | 1094 | icr = inb(iobase+ICR); | 
|  | 1095 | isr = inb(iobase+ISR) & icr; /* Mask out the interesting ones */ | 
|  | 1096 |  | 
|  | 1097 | outb(0, iobase+ICR); /* Disable interrupts */ | 
|  | 1098 |  | 
|  | 1099 | if (isr) { | 
|  | 1100 | /* Dispatch interrupt handler for the current speed */ | 
|  | 1101 | if (self->io.speed > PIO_MAX_SPEED ) | 
|  | 1102 | icr = w83977af_fir_interrupt(self, isr); | 
|  | 1103 | else | 
|  | 1104 | icr = w83977af_sir_interrupt(self, isr); | 
|  | 1105 | } | 
|  | 1106 |  | 
|  | 1107 | outb(icr, iobase+ICR);    /* Restore (new) interrupts */ | 
|  | 1108 | outb(set, iobase+SSR);    /* Restore bank register */ | 
|  | 1109 | return IRQ_RETVAL(isr); | 
|  | 1110 | } | 
|  | 1111 |  | 
|  | 1112 | /* | 
|  | 1113 | * Function w83977af_is_receiving (self) | 
|  | 1114 | * | 
|  | 1115 | *    Return TRUE is we are currently receiving a frame | 
|  | 1116 | * | 
|  | 1117 | */ | 
|  | 1118 | static int w83977af_is_receiving(struct w83977af_ir *self) | 
|  | 1119 | { | 
|  | 1120 | int status = FALSE; | 
|  | 1121 | int iobase; | 
|  | 1122 | __u8 set; | 
|  | 1123 |  | 
|  | 1124 | IRDA_ASSERT(self != NULL, return FALSE;); | 
|  | 1125 |  | 
|  | 1126 | if (self->io.speed > 115200) { | 
|  | 1127 | iobase = self->io.fir_base; | 
|  | 1128 |  | 
|  | 1129 | /* Check if rx FIFO is not empty */ | 
|  | 1130 | set = inb(iobase+SSR); | 
|  | 1131 | switch_bank(iobase, SET2); | 
|  | 1132 | if ((inb(iobase+RXFDTH) & 0x3f) != 0) { | 
|  | 1133 | /* We are receiving something */ | 
|  | 1134 | status =  TRUE; | 
|  | 1135 | } | 
|  | 1136 | outb(set, iobase+SSR); | 
|  | 1137 | } else | 
|  | 1138 | status = (self->rx_buff.state != OUTSIDE_FRAME); | 
|  | 1139 |  | 
|  | 1140 | return status; | 
|  | 1141 | } | 
|  | 1142 |  | 
|  | 1143 | /* | 
|  | 1144 | * Function w83977af_net_open (dev) | 
|  | 1145 | * | 
|  | 1146 | *    Start the device | 
|  | 1147 | * | 
|  | 1148 | */ | 
|  | 1149 | static int w83977af_net_open(struct net_device *dev) | 
|  | 1150 | { | 
|  | 1151 | struct w83977af_ir *self; | 
|  | 1152 | int iobase; | 
|  | 1153 | char hwname[32]; | 
|  | 1154 | __u8 set; | 
|  | 1155 |  | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 1156 | IRDA_DEBUG(0, "%s()\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1157 |  | 
|  | 1158 | IRDA_ASSERT(dev != NULL, return -1;); | 
| Wang Chen | 4cf1653 | 2008-11-12 23:38:14 -0800 | [diff] [blame] | 1159 | self = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1160 |  | 
|  | 1161 | IRDA_ASSERT(self != NULL, return 0;); | 
|  | 1162 |  | 
|  | 1163 | iobase = self->io.fir_base; | 
|  | 1164 |  | 
|  | 1165 | if (request_irq(self->io.irq, w83977af_interrupt, 0, dev->name, | 
|  | 1166 | (void *) dev)) { | 
|  | 1167 | return -EAGAIN; | 
|  | 1168 | } | 
|  | 1169 | /* | 
|  | 1170 | * Always allocate the DMA channel after the IRQ, | 
|  | 1171 | * and clean up on failure. | 
|  | 1172 | */ | 
|  | 1173 | if (request_dma(self->io.dma, dev->name)) { | 
|  | 1174 | free_irq(self->io.irq, self); | 
|  | 1175 | return -EAGAIN; | 
|  | 1176 | } | 
|  | 1177 |  | 
|  | 1178 | /* Save current set */ | 
|  | 1179 | set = inb(iobase+SSR); | 
|  | 1180 |  | 
|  | 1181 | /* Enable some interrupts so we can receive frames again */ | 
|  | 1182 | switch_bank(iobase, SET0); | 
|  | 1183 | if (self->io.speed > 115200) { | 
|  | 1184 | outb(ICR_EFSFI, iobase+ICR); | 
|  | 1185 | w83977af_dma_receive(self); | 
|  | 1186 | } else | 
|  | 1187 | outb(ICR_ERBRI, iobase+ICR); | 
|  | 1188 |  | 
|  | 1189 | /* Restore bank register */ | 
|  | 1190 | outb(set, iobase+SSR); | 
|  | 1191 |  | 
|  | 1192 | /* Ready to play! */ | 
|  | 1193 | netif_start_queue(dev); | 
|  | 1194 |  | 
|  | 1195 | /* Give self a hardware name */ | 
|  | 1196 | sprintf(hwname, "w83977af @ 0x%03x", self->io.fir_base); | 
|  | 1197 |  | 
|  | 1198 | /* | 
|  | 1199 | * Open new IrLAP layer instance, now that everything should be | 
|  | 1200 | * initialized properly | 
|  | 1201 | */ | 
|  | 1202 | self->irlap = irlap_open(dev, &self->qos, hwname); | 
|  | 1203 |  | 
|  | 1204 | return 0; | 
|  | 1205 | } | 
|  | 1206 |  | 
|  | 1207 | /* | 
|  | 1208 | * Function w83977af_net_close (dev) | 
|  | 1209 | * | 
|  | 1210 | *    Stop the device | 
|  | 1211 | * | 
|  | 1212 | */ | 
|  | 1213 | static int w83977af_net_close(struct net_device *dev) | 
|  | 1214 | { | 
|  | 1215 | struct w83977af_ir *self; | 
|  | 1216 | int iobase; | 
|  | 1217 | __u8 set; | 
|  | 1218 |  | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 1219 | IRDA_DEBUG(0, "%s()\n", __func__ ); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1220 |  | 
|  | 1221 | IRDA_ASSERT(dev != NULL, return -1;); | 
|  | 1222 |  | 
| Wang Chen | 4cf1653 | 2008-11-12 23:38:14 -0800 | [diff] [blame] | 1223 | self = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1224 |  | 
|  | 1225 | IRDA_ASSERT(self != NULL, return 0;); | 
|  | 1226 |  | 
|  | 1227 | iobase = self->io.fir_base; | 
|  | 1228 |  | 
|  | 1229 | /* Stop device */ | 
|  | 1230 | netif_stop_queue(dev); | 
|  | 1231 |  | 
|  | 1232 | /* Stop and remove instance of IrLAP */ | 
|  | 1233 | if (self->irlap) | 
|  | 1234 | irlap_close(self->irlap); | 
|  | 1235 | self->irlap = NULL; | 
|  | 1236 |  | 
|  | 1237 | disable_dma(self->io.dma); | 
|  | 1238 |  | 
|  | 1239 | /* Save current set */ | 
|  | 1240 | set = inb(iobase+SSR); | 
|  | 1241 |  | 
|  | 1242 | /* Disable interrupts */ | 
|  | 1243 | switch_bank(iobase, SET0); | 
|  | 1244 | outb(0, iobase+ICR); | 
|  | 1245 |  | 
|  | 1246 | free_irq(self->io.irq, dev); | 
|  | 1247 | free_dma(self->io.dma); | 
|  | 1248 |  | 
|  | 1249 | /* Restore bank register */ | 
|  | 1250 | outb(set, iobase+SSR); | 
|  | 1251 |  | 
|  | 1252 | return 0; | 
|  | 1253 | } | 
|  | 1254 |  | 
|  | 1255 | /* | 
|  | 1256 | * Function w83977af_net_ioctl (dev, rq, cmd) | 
|  | 1257 | * | 
|  | 1258 | *    Process IOCTL commands for this device | 
|  | 1259 | * | 
|  | 1260 | */ | 
|  | 1261 | static int w83977af_net_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) | 
|  | 1262 | { | 
|  | 1263 | struct if_irda_req *irq = (struct if_irda_req *) rq; | 
|  | 1264 | struct w83977af_ir *self; | 
|  | 1265 | unsigned long flags; | 
|  | 1266 | int ret = 0; | 
|  | 1267 |  | 
|  | 1268 | IRDA_ASSERT(dev != NULL, return -1;); | 
|  | 1269 |  | 
| Wang Chen | 4cf1653 | 2008-11-12 23:38:14 -0800 | [diff] [blame] | 1270 | self = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1271 |  | 
|  | 1272 | IRDA_ASSERT(self != NULL, return -1;); | 
|  | 1273 |  | 
| Harvey Harrison | a97a6f1 | 2008-07-30 17:20:18 -0700 | [diff] [blame] | 1274 | IRDA_DEBUG(2, "%s(), %s, (cmd=0x%X)\n", __func__ , dev->name, cmd); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1275 |  | 
|  | 1276 | spin_lock_irqsave(&self->lock, flags); | 
|  | 1277 |  | 
|  | 1278 | switch (cmd) { | 
|  | 1279 | case SIOCSBANDWIDTH: /* Set bandwidth */ | 
|  | 1280 | if (!capable(CAP_NET_ADMIN)) { | 
|  | 1281 | ret = -EPERM; | 
|  | 1282 | goto out; | 
|  | 1283 | } | 
|  | 1284 | w83977af_change_speed(self, irq->ifr_baudrate); | 
|  | 1285 | break; | 
|  | 1286 | case SIOCSMEDIABUSY: /* Set media busy */ | 
|  | 1287 | if (!capable(CAP_NET_ADMIN)) { | 
|  | 1288 | ret = -EPERM; | 
|  | 1289 | goto out; | 
|  | 1290 | } | 
|  | 1291 | irda_device_set_media_busy(self->netdev, TRUE); | 
|  | 1292 | break; | 
|  | 1293 | case SIOCGRECEIVING: /* Check if we are receiving right now */ | 
|  | 1294 | irq->ifr_receiving = w83977af_is_receiving(self); | 
|  | 1295 | break; | 
|  | 1296 | default: | 
|  | 1297 | ret = -EOPNOTSUPP; | 
|  | 1298 | } | 
|  | 1299 | out: | 
|  | 1300 | spin_unlock_irqrestore(&self->lock, flags); | 
|  | 1301 | return ret; | 
|  | 1302 | } | 
|  | 1303 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1304 | MODULE_AUTHOR("Dag Brattli <dagb@cs.uit.no>"); | 
|  | 1305 | MODULE_DESCRIPTION("Winbond W83977AF IrDA Device Driver"); | 
|  | 1306 | MODULE_LICENSE("GPL"); | 
|  | 1307 |  | 
|  | 1308 |  | 
|  | 1309 | module_param(qos_mtt_bits, int, 0); | 
|  | 1310 | MODULE_PARM_DESC(qos_mtt_bits, "Mimimum Turn Time"); | 
|  | 1311 | module_param_array(io, int, NULL, 0); | 
|  | 1312 | MODULE_PARM_DESC(io, "Base I/O addresses"); | 
|  | 1313 | module_param_array(irq, int, NULL, 0); | 
|  | 1314 | MODULE_PARM_DESC(irq, "IRQ lines"); | 
|  | 1315 |  | 
|  | 1316 | /* | 
|  | 1317 | * Function init_module (void) | 
|  | 1318 | * | 
|  | 1319 | * | 
|  | 1320 | * | 
|  | 1321 | */ | 
|  | 1322 | module_init(w83977af_init); | 
|  | 1323 |  | 
|  | 1324 | /* | 
|  | 1325 | * Function cleanup_module (void) | 
|  | 1326 | * | 
|  | 1327 | * | 
|  | 1328 | * | 
|  | 1329 | */ | 
|  | 1330 | module_exit(w83977af_cleanup); |