| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /********************************************************************* | 
|  | 2 | * | 
|  | 3 | * Filename:      irda_device.c | 
|  | 4 | * Version:       0.9 | 
|  | 5 | * Description:   Utility functions used by the device drivers | 
|  | 6 | * Status:        Experimental. | 
|  | 7 | * Author:        Dag Brattli <dagb@cs.uit.no> | 
|  | 8 | * Created at:    Sat Oct  9 09:22:27 1999 | 
|  | 9 | * Modified at:   Sun Jan 23 17:41:24 2000 | 
|  | 10 | * Modified by:   Dag Brattli <dagb@cs.uit.no> | 
|  | 11 | * | 
|  | 12 | *     Copyright (c) 1999-2000 Dag Brattli, All Rights Reserved. | 
|  | 13 | *     Copyright (c) 2000-2001 Jean Tourrilhes <jt@hpl.hp.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 | *     This program is distributed in the hope that it will be useful, | 
|  | 21 | *     but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | 22 | *     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | 
|  | 23 | *     GNU General Public License for more details. | 
|  | 24 | * | 
|  | 25 | *     You should have received a copy of the GNU General Public License | 
|  | 26 | *     along with this program; if not, write to the Free Software | 
|  | 27 | *     Foundation, Inc., 59 Temple Place, Suite 330, Boston, | 
|  | 28 | *     MA 02111-1307 USA | 
|  | 29 | * | 
|  | 30 | ********************************************************************/ | 
|  | 31 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 32 | #include <linux/string.h> | 
|  | 33 | #include <linux/proc_fs.h> | 
|  | 34 | #include <linux/skbuff.h> | 
| Randy Dunlap | 4fc268d | 2006-01-11 12:17:47 -0800 | [diff] [blame] | 35 | #include <linux/capability.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 36 | #include <linux/if.h> | 
|  | 37 | #include <linux/if_ether.h> | 
|  | 38 | #include <linux/if_arp.h> | 
|  | 39 | #include <linux/netdevice.h> | 
|  | 40 | #include <linux/init.h> | 
|  | 41 | #include <linux/tty.h> | 
|  | 42 | #include <linux/kmod.h> | 
|  | 43 | #include <linux/spinlock.h> | 
|  | 44 |  | 
|  | 45 | #include <asm/ioctls.h> | 
|  | 46 | #include <asm/uaccess.h> | 
|  | 47 | #include <asm/dma.h> | 
|  | 48 | #include <asm/io.h> | 
|  | 49 |  | 
|  | 50 | #include <net/irda/irda_device.h> | 
|  | 51 | #include <net/irda/irlap.h> | 
|  | 52 | #include <net/irda/timer.h> | 
|  | 53 | #include <net/irda/wrapper.h> | 
|  | 54 |  | 
|  | 55 | static void __irda_task_delete(struct irda_task *task); | 
|  | 56 |  | 
|  | 57 | static hashbin_t *dongles = NULL; | 
|  | 58 | static hashbin_t *tasks = NULL; | 
|  | 59 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 60 | static void irda_task_timer_expired(void *data); | 
|  | 61 |  | 
|  | 62 | int __init irda_device_init( void) | 
|  | 63 | { | 
|  | 64 | dongles = hashbin_new(HB_NOLOCK); | 
|  | 65 | if (dongles == NULL) { | 
|  | 66 | IRDA_WARNING("IrDA: Can't allocate dongles hashbin!\n"); | 
|  | 67 | return -ENOMEM; | 
|  | 68 | } | 
|  | 69 | spin_lock_init(&dongles->hb_spinlock); | 
|  | 70 |  | 
|  | 71 | tasks = hashbin_new(HB_LOCK); | 
|  | 72 | if (tasks == NULL) { | 
|  | 73 | IRDA_WARNING("IrDA: Can't allocate tasks hashbin!\n"); | 
|  | 74 | hashbin_delete(dongles, NULL); | 
|  | 75 | return -ENOMEM; | 
|  | 76 | } | 
|  | 77 |  | 
|  | 78 | /* We no longer initialise the driver ourselves here, we let | 
|  | 79 | * the system do it for us... - Jean II */ | 
|  | 80 |  | 
|  | 81 | return 0; | 
|  | 82 | } | 
|  | 83 |  | 
| Samuel Ortiz | 75a69ac | 2007-07-18 02:16:30 -0700 | [diff] [blame] | 84 | static void leftover_dongle(void *arg) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 85 | { | 
|  | 86 | struct dongle_reg *reg = arg; | 
|  | 87 | IRDA_WARNING("IrDA: Dongle type %x not unregistered\n", | 
|  | 88 | reg->type); | 
|  | 89 | } | 
|  | 90 |  | 
| Samuel Ortiz | 75a69ac | 2007-07-18 02:16:30 -0700 | [diff] [blame] | 91 | void irda_device_cleanup(void) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 92 | { | 
| Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 93 | IRDA_DEBUG(4, "%s()\n", __func__); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 94 |  | 
|  | 95 | hashbin_delete(tasks, (FREE_FUNC) __irda_task_delete); | 
|  | 96 |  | 
|  | 97 | hashbin_delete(dongles, leftover_dongle); | 
|  | 98 | } | 
|  | 99 |  | 
|  | 100 | /* | 
|  | 101 | * Function irda_device_set_media_busy (self, status) | 
|  | 102 | * | 
|  | 103 | *    Called when we have detected that another station is transmitting | 
|  | 104 | *    in contention mode. | 
|  | 105 | */ | 
|  | 106 | void irda_device_set_media_busy(struct net_device *dev, int status) | 
|  | 107 | { | 
|  | 108 | struct irlap_cb *self; | 
|  | 109 |  | 
| Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 110 | IRDA_DEBUG(4, "%s(%s)\n", __func__, status ? "TRUE" : "FALSE"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 111 |  | 
|  | 112 | self = (struct irlap_cb *) dev->atalk_ptr; | 
|  | 113 |  | 
| Jean Tourrilhes | 7e5c6bc | 2005-04-16 15:24:11 -0700 | [diff] [blame] | 114 | /* Some drivers may enable the receive interrupt before calling | 
|  | 115 | * irlap_open(), or they may disable the receive interrupt | 
|  | 116 | * after calling irlap_close(). | 
|  | 117 | * The IrDA stack is protected from this in irlap_driver_rcv(). | 
|  | 118 | * However, the driver calls directly the wrapper, that calls | 
|  | 119 | * us directly. Make sure we protect ourselves. | 
|  | 120 | * Jean II */ | 
|  | 121 | if (!self || self->magic != LAP_MAGIC) | 
|  | 122 | return; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 123 |  | 
|  | 124 | if (status) { | 
|  | 125 | self->media_busy = TRUE; | 
|  | 126 | if (status == SMALL) | 
|  | 127 | irlap_start_mbusy_timer(self, SMALLBUSY_TIMEOUT); | 
|  | 128 | else | 
|  | 129 | irlap_start_mbusy_timer(self, MEDIABUSY_TIMEOUT); | 
|  | 130 | IRDA_DEBUG( 4, "Media busy!\n"); | 
|  | 131 | } else { | 
|  | 132 | self->media_busy = FALSE; | 
|  | 133 | irlap_stop_mbusy_timer(self); | 
|  | 134 | } | 
|  | 135 | } | 
|  | 136 | EXPORT_SYMBOL(irda_device_set_media_busy); | 
|  | 137 |  | 
|  | 138 |  | 
|  | 139 | /* | 
|  | 140 | * Function irda_device_is_receiving (dev) | 
|  | 141 | * | 
|  | 142 | *    Check if the device driver is currently receiving data | 
|  | 143 | * | 
|  | 144 | */ | 
|  | 145 | int irda_device_is_receiving(struct net_device *dev) | 
|  | 146 | { | 
|  | 147 | struct if_irda_req req; | 
|  | 148 | int ret; | 
|  | 149 |  | 
| Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 150 | IRDA_DEBUG(2, "%s()\n", __func__); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 151 |  | 
|  | 152 | if (!dev->do_ioctl) { | 
|  | 153 | IRDA_ERROR("%s: do_ioctl not impl. by device driver\n", | 
| Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 154 | __func__); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 155 | return -1; | 
|  | 156 | } | 
|  | 157 |  | 
|  | 158 | ret = dev->do_ioctl(dev, (struct ifreq *) &req, SIOCGRECEIVING); | 
|  | 159 | if (ret < 0) | 
|  | 160 | return ret; | 
|  | 161 |  | 
|  | 162 | return req.ifr_receiving; | 
|  | 163 | } | 
|  | 164 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 165 | static void __irda_task_delete(struct irda_task *task) | 
|  | 166 | { | 
|  | 167 | del_timer(&task->timer); | 
|  | 168 |  | 
|  | 169 | kfree(task); | 
|  | 170 | } | 
|  | 171 |  | 
| Adrian Bunk | e9888f5 | 2008-01-19 00:00:42 -0800 | [diff] [blame] | 172 | static void irda_task_delete(struct irda_task *task) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 173 | { | 
|  | 174 | /* Unregister task */ | 
|  | 175 | hashbin_remove(tasks, (long) task, NULL); | 
|  | 176 |  | 
|  | 177 | __irda_task_delete(task); | 
|  | 178 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 179 |  | 
|  | 180 | /* | 
|  | 181 | * Function irda_task_kick (task) | 
|  | 182 | * | 
|  | 183 | *    Tries to execute a task possible multiple times until the task is either | 
|  | 184 | *    finished, or askes for a timeout. When a task is finished, we do post | 
|  | 185 | *    processing, and notify the parent task, that is waiting for this task | 
|  | 186 | *    to complete. | 
|  | 187 | */ | 
|  | 188 | static int irda_task_kick(struct irda_task *task) | 
|  | 189 | { | 
|  | 190 | int finished = TRUE; | 
|  | 191 | int count = 0; | 
|  | 192 | int timeout; | 
|  | 193 |  | 
| Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 194 | IRDA_DEBUG(2, "%s()\n", __func__); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 195 |  | 
|  | 196 | IRDA_ASSERT(task != NULL, return -1;); | 
|  | 197 | IRDA_ASSERT(task->magic == IRDA_TASK_MAGIC, return -1;); | 
|  | 198 |  | 
|  | 199 | /* Execute task until it's finished, or askes for a timeout */ | 
|  | 200 | do { | 
|  | 201 | timeout = task->function(task); | 
|  | 202 | if (count++ > 100) { | 
|  | 203 | IRDA_ERROR("%s: error in task handler!\n", | 
| Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 204 | __func__); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 205 | irda_task_delete(task); | 
|  | 206 | return TRUE; | 
|  | 207 | } | 
|  | 208 | } while ((timeout == 0) && (task->state != IRDA_TASK_DONE)); | 
|  | 209 |  | 
|  | 210 | if (timeout < 0) { | 
| Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 211 | IRDA_ERROR("%s: Error executing task!\n", __func__); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 212 | irda_task_delete(task); | 
|  | 213 | return TRUE; | 
|  | 214 | } | 
|  | 215 |  | 
|  | 216 | /* Check if we are finished */ | 
|  | 217 | if (task->state == IRDA_TASK_DONE) { | 
|  | 218 | del_timer(&task->timer); | 
|  | 219 |  | 
|  | 220 | /* Do post processing */ | 
|  | 221 | if (task->finished) | 
|  | 222 | task->finished(task); | 
|  | 223 |  | 
|  | 224 | /* Notify parent */ | 
|  | 225 | if (task->parent) { | 
|  | 226 | /* Check if parent is waiting for us to complete */ | 
|  | 227 | if (task->parent->state == IRDA_TASK_CHILD_WAIT) { | 
|  | 228 | task->parent->state = IRDA_TASK_CHILD_DONE; | 
|  | 229 |  | 
|  | 230 | /* Stop timer now that we are here */ | 
|  | 231 | del_timer(&task->parent->timer); | 
|  | 232 |  | 
|  | 233 | /* Kick parent task */ | 
|  | 234 | irda_task_kick(task->parent); | 
|  | 235 | } | 
|  | 236 | } | 
|  | 237 | irda_task_delete(task); | 
|  | 238 | } else if (timeout > 0) { | 
|  | 239 | irda_start_timer(&task->timer, timeout, (void *) task, | 
|  | 240 | irda_task_timer_expired); | 
|  | 241 | finished = FALSE; | 
|  | 242 | } else { | 
|  | 243 | IRDA_DEBUG(0, "%s(), not finished, and no timeout!\n", | 
| Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 244 | __func__); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 245 | finished = FALSE; | 
|  | 246 | } | 
|  | 247 |  | 
|  | 248 | return finished; | 
|  | 249 | } | 
|  | 250 |  | 
|  | 251 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 252 | * Function irda_task_timer_expired (data) | 
|  | 253 | * | 
|  | 254 | *    Task time has expired. We now try to execute task (again), and restart | 
|  | 255 | *    the timer if the task has not finished yet | 
|  | 256 | */ | 
|  | 257 | static void irda_task_timer_expired(void *data) | 
|  | 258 | { | 
|  | 259 | struct irda_task *task; | 
|  | 260 |  | 
| Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 261 | IRDA_DEBUG(2, "%s()\n", __func__); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 262 |  | 
|  | 263 | task = (struct irda_task *) data; | 
|  | 264 |  | 
|  | 265 | irda_task_kick(task); | 
|  | 266 | } | 
|  | 267 |  | 
|  | 268 | /* | 
|  | 269 | * Function irda_device_setup (dev) | 
|  | 270 | * | 
|  | 271 | *    This function should be used by low level device drivers in a similar way | 
|  | 272 | *    as ether_setup() is used by normal network device drivers | 
|  | 273 | */ | 
|  | 274 | static void irda_device_setup(struct net_device *dev) | 
|  | 275 | { | 
| YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 276 | dev->hard_header_len = 0; | 
|  | 277 | dev->addr_len        = LAP_ALEN; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 278 |  | 
| YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 279 | dev->type            = ARPHRD_IRDA; | 
|  | 280 | dev->tx_queue_len    = 8; /* Window size + 1 s-frame */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 281 |  | 
| Samuel Ortiz | d93077f | 2006-02-09 16:58:46 -0800 | [diff] [blame] | 282 | memset(dev->broadcast, 0xff, LAP_ALEN); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 283 |  | 
|  | 284 | dev->mtu = 2048; | 
|  | 285 | dev->flags = IFF_NOARP; | 
|  | 286 | } | 
|  | 287 |  | 
|  | 288 | /* | 
| YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 289 | * Funciton  alloc_irdadev | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 290 | * 	Allocates and sets up an IRDA device in a manner similar to | 
|  | 291 | * 	alloc_etherdev. | 
|  | 292 | */ | 
|  | 293 | struct net_device *alloc_irdadev(int sizeof_priv) | 
|  | 294 | { | 
|  | 295 | return alloc_netdev(sizeof_priv, "irda%d", irda_device_setup); | 
|  | 296 | } | 
|  | 297 | EXPORT_SYMBOL(alloc_irdadev); | 
|  | 298 |  | 
| Al Viro | 56c3b7d | 2005-05-04 05:39:52 +0100 | [diff] [blame] | 299 | #ifdef CONFIG_ISA_DMA_API | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 300 | /* | 
|  | 301 | * Function setup_dma (idev, buffer, count, mode) | 
|  | 302 | * | 
| Andi Kleen | b6d9a5d | 2005-04-16 15:24:56 -0700 | [diff] [blame] | 303 | *    Setup the DMA channel. Commonly used by LPC FIR drivers | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 304 | * | 
|  | 305 | */ | 
|  | 306 | void irda_setup_dma(int channel, dma_addr_t buffer, int count, int mode) | 
|  | 307 | { | 
|  | 308 | unsigned long flags; | 
|  | 309 |  | 
|  | 310 | flags = claim_dma_lock(); | 
|  | 311 |  | 
|  | 312 | disable_dma(channel); | 
|  | 313 | clear_dma_ff(channel); | 
|  | 314 | set_dma_mode(channel, mode); | 
|  | 315 | set_dma_addr(channel, buffer); | 
|  | 316 | set_dma_count(channel, count); | 
|  | 317 | enable_dma(channel); | 
|  | 318 |  | 
|  | 319 | release_dma_lock(flags); | 
|  | 320 | } | 
|  | 321 | EXPORT_SYMBOL(irda_setup_dma); | 
| Al Viro | 56c3b7d | 2005-05-04 05:39:52 +0100 | [diff] [blame] | 322 | #endif |