Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1 | /* |
| 2 | * Stuff used by all variants of the driver |
| 3 | * |
Tilman Schmidt | 70440cf | 2006-04-10 22:55:14 -0700 | [diff] [blame] | 4 | * Copyright (c) 2001 by Stefan Eilers, |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 5 | * Hansjoerg Lipp <hjlipp@web.de>, |
| 6 | * Tilman Schmidt <tilman@imap.cc>. |
| 7 | * |
| 8 | * ===================================================================== |
| 9 | * This program is free software; you can redistribute it and/or |
| 10 | * modify it under the terms of the GNU General Public License as |
| 11 | * published by the Free Software Foundation; either version 2 of |
| 12 | * the License, or (at your option) any later version. |
| 13 | * ===================================================================== |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 14 | */ |
| 15 | |
| 16 | #include "gigaset.h" |
| 17 | #include <linux/ctype.h> |
| 18 | #include <linux/module.h> |
| 19 | #include <linux/moduleparam.h> |
| 20 | |
| 21 | /* Version Information */ |
Tilman Schmidt | 70440cf | 2006-04-10 22:55:14 -0700 | [diff] [blame] | 22 | #define DRIVER_AUTHOR "Hansjoerg Lipp <hjlipp@web.de>, Tilman Schmidt <tilman@imap.cc>, Stefan Eilers" |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 23 | #define DRIVER_DESC "Driver for Gigaset 307x" |
| 24 | |
| 25 | /* Module parameters */ |
| 26 | int gigaset_debuglevel = DEBUG_DEFAULT; |
| 27 | EXPORT_SYMBOL_GPL(gigaset_debuglevel); |
| 28 | module_param_named(debug, gigaset_debuglevel, int, S_IRUGO|S_IWUSR); |
| 29 | MODULE_PARM_DESC(debug, "debug level"); |
| 30 | |
Tilman Schmidt | 70440cf | 2006-04-10 22:55:14 -0700 | [diff] [blame] | 31 | /* driver state flags */ |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 32 | #define VALID_MINOR 0x01 |
| 33 | #define VALID_ID 0x02 |
| 34 | #define ASSIGNED 0x04 |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 35 | |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 36 | void gigaset_dbg_buffer(enum debuglevel level, const unsigned char *msg, |
Tilman Schmidt | 0137150 | 2006-04-10 22:55:11 -0700 | [diff] [blame] | 37 | size_t len, const unsigned char *buf) |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 38 | { |
| 39 | unsigned char outbuf[80]; |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 40 | unsigned char c; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 41 | size_t space = sizeof outbuf - 1; |
| 42 | unsigned char *out = outbuf; |
Tilman Schmidt | 0137150 | 2006-04-10 22:55:11 -0700 | [diff] [blame] | 43 | size_t numin = len; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 44 | |
Tilman Schmidt | 0137150 | 2006-04-10 22:55:11 -0700 | [diff] [blame] | 45 | while (numin--) { |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 46 | c = *buf++; |
| 47 | if (c == '~' || c == '^' || c == '\\') { |
Tilman Schmidt | 0137150 | 2006-04-10 22:55:11 -0700 | [diff] [blame] | 48 | if (!space--) |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 49 | break; |
| 50 | *out++ = '\\'; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 51 | } |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 52 | if (c & 0x80) { |
Tilman Schmidt | 0137150 | 2006-04-10 22:55:11 -0700 | [diff] [blame] | 53 | if (!space--) |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 54 | break; |
| 55 | *out++ = '~'; |
| 56 | c ^= 0x80; |
| 57 | } |
| 58 | if (c < 0x20 || c == 0x7f) { |
Tilman Schmidt | 0137150 | 2006-04-10 22:55:11 -0700 | [diff] [blame] | 59 | if (!space--) |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 60 | break; |
| 61 | *out++ = '^'; |
| 62 | c ^= 0x40; |
| 63 | } |
Tilman Schmidt | 0137150 | 2006-04-10 22:55:11 -0700 | [diff] [blame] | 64 | if (!space--) |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 65 | break; |
| 66 | *out++ = c; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 67 | } |
| 68 | *out = 0; |
| 69 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 70 | gig_dbg(level, "%s (%u bytes): %s", msg, (unsigned) len, outbuf); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 71 | } |
| 72 | EXPORT_SYMBOL_GPL(gigaset_dbg_buffer); |
| 73 | |
| 74 | static int setflags(struct cardstate *cs, unsigned flags, unsigned delay) |
| 75 | { |
| 76 | int r; |
| 77 | |
| 78 | r = cs->ops->set_modem_ctrl(cs, cs->control_state, flags); |
| 79 | cs->control_state = flags; |
| 80 | if (r < 0) |
| 81 | return r; |
| 82 | |
| 83 | if (delay) { |
| 84 | set_current_state(TASK_INTERRUPTIBLE); |
| 85 | schedule_timeout(delay * HZ / 1000); |
| 86 | } |
| 87 | |
| 88 | return 0; |
| 89 | } |
| 90 | |
| 91 | int gigaset_enterconfigmode(struct cardstate *cs) |
| 92 | { |
| 93 | int i, r; |
| 94 | |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 95 | cs->control_state = TIOCM_RTS; //FIXME |
| 96 | |
| 97 | r = setflags(cs, TIOCM_DTR, 200); |
| 98 | if (r < 0) |
| 99 | goto error; |
| 100 | r = setflags(cs, 0, 200); |
| 101 | if (r < 0) |
| 102 | goto error; |
| 103 | for (i = 0; i < 5; ++i) { |
| 104 | r = setflags(cs, TIOCM_RTS, 100); |
| 105 | if (r < 0) |
| 106 | goto error; |
| 107 | r = setflags(cs, 0, 100); |
| 108 | if (r < 0) |
| 109 | goto error; |
| 110 | } |
| 111 | r = setflags(cs, TIOCM_RTS|TIOCM_DTR, 800); |
| 112 | if (r < 0) |
| 113 | goto error; |
| 114 | |
| 115 | return 0; |
| 116 | |
| 117 | error: |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 118 | dev_err(cs->dev, "error %d on setuartbits\n", -r); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 119 | cs->control_state = TIOCM_RTS|TIOCM_DTR; // FIXME is this a good value? |
| 120 | cs->ops->set_modem_ctrl(cs, 0, TIOCM_RTS|TIOCM_DTR); |
| 121 | |
| 122 | return -1; //r |
| 123 | } |
| 124 | |
| 125 | static int test_timeout(struct at_state_t *at_state) |
| 126 | { |
| 127 | if (!at_state->timer_expires) |
| 128 | return 0; |
| 129 | |
| 130 | if (--at_state->timer_expires) { |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 131 | gig_dbg(DEBUG_MCMD, "decreased timer of %p to %lu", |
| 132 | at_state, at_state->timer_expires); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 133 | return 0; |
| 134 | } |
| 135 | |
| 136 | if (!gigaset_add_event(at_state->cs, at_state, EV_TIMEOUT, NULL, |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 137 | at_state->timer_index, NULL)) { |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 138 | //FIXME what should we do? |
| 139 | } |
| 140 | |
| 141 | return 1; |
| 142 | } |
| 143 | |
| 144 | static void timer_tick(unsigned long data) |
| 145 | { |
| 146 | struct cardstate *cs = (struct cardstate *) data; |
| 147 | unsigned long flags; |
| 148 | unsigned channel; |
| 149 | struct at_state_t *at_state; |
| 150 | int timeout = 0; |
| 151 | |
| 152 | spin_lock_irqsave(&cs->lock, flags); |
| 153 | |
| 154 | for (channel = 0; channel < cs->channels; ++channel) |
| 155 | if (test_timeout(&cs->bcs[channel].at_state)) |
| 156 | timeout = 1; |
| 157 | |
| 158 | if (test_timeout(&cs->at_state)) |
| 159 | timeout = 1; |
| 160 | |
| 161 | list_for_each_entry(at_state, &cs->temp_at_states, list) |
| 162 | if (test_timeout(at_state)) |
| 163 | timeout = 1; |
| 164 | |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 165 | if (cs->running) { |
Tilman Schmidt | ec81b5e6 | 2006-04-10 22:55:03 -0700 | [diff] [blame] | 166 | mod_timer(&cs->timer, jiffies + msecs_to_jiffies(GIG_TICK)); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 167 | if (timeout) { |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 168 | gig_dbg(DEBUG_CMD, "scheduling timeout"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 169 | tasklet_schedule(&cs->event_tasklet); |
| 170 | } |
| 171 | } |
| 172 | |
| 173 | spin_unlock_irqrestore(&cs->lock, flags); |
| 174 | } |
| 175 | |
| 176 | int gigaset_get_channel(struct bc_state *bcs) |
| 177 | { |
| 178 | unsigned long flags; |
| 179 | |
| 180 | spin_lock_irqsave(&bcs->cs->lock, flags); |
| 181 | if (bcs->use_count) { |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 182 | gig_dbg(DEBUG_ANY, "could not allocate channel %d", |
| 183 | bcs->channel); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 184 | spin_unlock_irqrestore(&bcs->cs->lock, flags); |
| 185 | return 0; |
| 186 | } |
| 187 | ++bcs->use_count; |
| 188 | bcs->busy = 1; |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 189 | gig_dbg(DEBUG_ANY, "allocated channel %d", bcs->channel); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 190 | spin_unlock_irqrestore(&bcs->cs->lock, flags); |
| 191 | return 1; |
| 192 | } |
| 193 | |
| 194 | void gigaset_free_channel(struct bc_state *bcs) |
| 195 | { |
| 196 | unsigned long flags; |
| 197 | |
| 198 | spin_lock_irqsave(&bcs->cs->lock, flags); |
| 199 | if (!bcs->busy) { |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 200 | gig_dbg(DEBUG_ANY, "could not free channel %d", bcs->channel); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 201 | spin_unlock_irqrestore(&bcs->cs->lock, flags); |
| 202 | return; |
| 203 | } |
| 204 | --bcs->use_count; |
| 205 | bcs->busy = 0; |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 206 | gig_dbg(DEBUG_ANY, "freed channel %d", bcs->channel); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 207 | spin_unlock_irqrestore(&bcs->cs->lock, flags); |
| 208 | } |
| 209 | |
| 210 | int gigaset_get_channels(struct cardstate *cs) |
| 211 | { |
| 212 | unsigned long flags; |
| 213 | int i; |
| 214 | |
| 215 | spin_lock_irqsave(&cs->lock, flags); |
| 216 | for (i = 0; i < cs->channels; ++i) |
| 217 | if (cs->bcs[i].use_count) { |
| 218 | spin_unlock_irqrestore(&cs->lock, flags); |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 219 | gig_dbg(DEBUG_ANY, "could not allocate all channels"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 220 | return 0; |
| 221 | } |
| 222 | for (i = 0; i < cs->channels; ++i) |
| 223 | ++cs->bcs[i].use_count; |
| 224 | spin_unlock_irqrestore(&cs->lock, flags); |
| 225 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 226 | gig_dbg(DEBUG_ANY, "allocated all channels"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 227 | |
| 228 | return 1; |
| 229 | } |
| 230 | |
| 231 | void gigaset_free_channels(struct cardstate *cs) |
| 232 | { |
| 233 | unsigned long flags; |
| 234 | int i; |
| 235 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 236 | gig_dbg(DEBUG_ANY, "unblocking all channels"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 237 | spin_lock_irqsave(&cs->lock, flags); |
| 238 | for (i = 0; i < cs->channels; ++i) |
| 239 | --cs->bcs[i].use_count; |
| 240 | spin_unlock_irqrestore(&cs->lock, flags); |
| 241 | } |
| 242 | |
| 243 | void gigaset_block_channels(struct cardstate *cs) |
| 244 | { |
| 245 | unsigned long flags; |
| 246 | int i; |
| 247 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 248 | gig_dbg(DEBUG_ANY, "blocking all channels"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 249 | spin_lock_irqsave(&cs->lock, flags); |
| 250 | for (i = 0; i < cs->channels; ++i) |
| 251 | ++cs->bcs[i].use_count; |
| 252 | spin_unlock_irqrestore(&cs->lock, flags); |
| 253 | } |
| 254 | |
| 255 | static void clear_events(struct cardstate *cs) |
| 256 | { |
| 257 | struct event_t *ev; |
| 258 | unsigned head, tail; |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 259 | unsigned long flags; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 260 | |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 261 | spin_lock_irqsave(&cs->ev_lock, flags); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 262 | |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 263 | head = cs->ev_head; |
| 264 | tail = cs->ev_tail; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 265 | |
| 266 | while (tail != head) { |
| 267 | ev = cs->events + head; |
| 268 | kfree(ev->ptr); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 269 | head = (head + 1) % MAX_EVENTS; |
| 270 | } |
| 271 | |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 272 | cs->ev_head = tail; |
| 273 | |
| 274 | spin_unlock_irqrestore(&cs->ev_lock, flags); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 275 | } |
| 276 | |
| 277 | struct event_t *gigaset_add_event(struct cardstate *cs, |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 278 | struct at_state_t *at_state, int type, |
| 279 | void *ptr, int parameter, void *arg) |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 280 | { |
| 281 | unsigned long flags; |
| 282 | unsigned next, tail; |
| 283 | struct event_t *event = NULL; |
| 284 | |
| 285 | spin_lock_irqsave(&cs->ev_lock, flags); |
| 286 | |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 287 | tail = cs->ev_tail; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 288 | next = (tail + 1) % MAX_EVENTS; |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 289 | if (unlikely(next == cs->ev_head)) |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 290 | err("event queue full"); |
| 291 | else { |
| 292 | event = cs->events + tail; |
| 293 | event->type = type; |
| 294 | event->at_state = at_state; |
| 295 | event->cid = -1; |
| 296 | event->ptr = ptr; |
| 297 | event->arg = arg; |
| 298 | event->parameter = parameter; |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 299 | cs->ev_tail = next; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 300 | } |
| 301 | |
| 302 | spin_unlock_irqrestore(&cs->ev_lock, flags); |
| 303 | |
| 304 | return event; |
| 305 | } |
| 306 | EXPORT_SYMBOL_GPL(gigaset_add_event); |
| 307 | |
| 308 | static void free_strings(struct at_state_t *at_state) |
| 309 | { |
| 310 | int i; |
| 311 | |
| 312 | for (i = 0; i < STR_NUM; ++i) { |
| 313 | kfree(at_state->str_var[i]); |
| 314 | at_state->str_var[i] = NULL; |
| 315 | } |
| 316 | } |
| 317 | |
| 318 | static void clear_at_state(struct at_state_t *at_state) |
| 319 | { |
| 320 | free_strings(at_state); |
| 321 | } |
| 322 | |
| 323 | static void dealloc_at_states(struct cardstate *cs) |
| 324 | { |
| 325 | struct at_state_t *cur, *next; |
| 326 | |
| 327 | list_for_each_entry_safe(cur, next, &cs->temp_at_states, list) { |
| 328 | list_del(&cur->list); |
| 329 | free_strings(cur); |
| 330 | kfree(cur); |
| 331 | } |
| 332 | } |
| 333 | |
| 334 | static void gigaset_freebcs(struct bc_state *bcs) |
| 335 | { |
| 336 | int i; |
| 337 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 338 | gig_dbg(DEBUG_INIT, "freeing bcs[%d]->hw", bcs->channel); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 339 | if (!bcs->cs->ops->freebcshw(bcs)) { |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 340 | gig_dbg(DEBUG_INIT, "failed"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 341 | } |
| 342 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 343 | gig_dbg(DEBUG_INIT, "clearing bcs[%d]->at_state", bcs->channel); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 344 | clear_at_state(&bcs->at_state); |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 345 | gig_dbg(DEBUG_INIT, "freeing bcs[%d]->skb", bcs->channel); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 346 | |
| 347 | if (bcs->skb) |
| 348 | dev_kfree_skb(bcs->skb); |
| 349 | for (i = 0; i < AT_NUM; ++i) { |
| 350 | kfree(bcs->commands[i]); |
| 351 | bcs->commands[i] = NULL; |
| 352 | } |
| 353 | } |
| 354 | |
Tilman Schmidt | 70440cf | 2006-04-10 22:55:14 -0700 | [diff] [blame] | 355 | static struct cardstate *alloc_cs(struct gigaset_driver *drv) |
| 356 | { |
| 357 | unsigned long flags; |
| 358 | unsigned i; |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 359 | struct cardstate *ret = NULL; |
Tilman Schmidt | 70440cf | 2006-04-10 22:55:14 -0700 | [diff] [blame] | 360 | |
| 361 | spin_lock_irqsave(&drv->lock, flags); |
| 362 | for (i = 0; i < drv->minors; ++i) { |
| 363 | if (!(drv->flags[i] & VALID_MINOR)) { |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 364 | if (try_module_get(drv->owner)) { |
| 365 | drv->flags[i] = VALID_MINOR; |
| 366 | ret = drv->cs + i; |
| 367 | } |
Tilman Schmidt | 70440cf | 2006-04-10 22:55:14 -0700 | [diff] [blame] | 368 | break; |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 369 | } |
Tilman Schmidt | 70440cf | 2006-04-10 22:55:14 -0700 | [diff] [blame] | 370 | } |
| 371 | spin_unlock_irqrestore(&drv->lock, flags); |
| 372 | return ret; |
| 373 | } |
| 374 | |
| 375 | static void free_cs(struct cardstate *cs) |
| 376 | { |
| 377 | unsigned long flags; |
| 378 | struct gigaset_driver *drv = cs->driver; |
| 379 | spin_lock_irqsave(&drv->lock, flags); |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 380 | if (drv->flags[cs->minor_index] & VALID_MINOR) |
| 381 | module_put(drv->owner); |
Tilman Schmidt | 70440cf | 2006-04-10 22:55:14 -0700 | [diff] [blame] | 382 | drv->flags[cs->minor_index] = 0; |
| 383 | spin_unlock_irqrestore(&drv->lock, flags); |
| 384 | } |
| 385 | |
| 386 | static void make_valid(struct cardstate *cs, unsigned mask) |
| 387 | { |
| 388 | unsigned long flags; |
| 389 | struct gigaset_driver *drv = cs->driver; |
| 390 | spin_lock_irqsave(&drv->lock, flags); |
| 391 | drv->flags[cs->minor_index] |= mask; |
| 392 | spin_unlock_irqrestore(&drv->lock, flags); |
| 393 | } |
| 394 | |
| 395 | static void make_invalid(struct cardstate *cs, unsigned mask) |
| 396 | { |
| 397 | unsigned long flags; |
| 398 | struct gigaset_driver *drv = cs->driver; |
| 399 | spin_lock_irqsave(&drv->lock, flags); |
| 400 | drv->flags[cs->minor_index] &= ~mask; |
| 401 | spin_unlock_irqrestore(&drv->lock, flags); |
| 402 | } |
| 403 | |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 404 | void gigaset_freecs(struct cardstate *cs) |
| 405 | { |
| 406 | int i; |
| 407 | unsigned long flags; |
| 408 | |
| 409 | if (!cs) |
| 410 | return; |
| 411 | |
Tilman Schmidt | abfd1dc | 2006-04-10 22:55:12 -0700 | [diff] [blame] | 412 | mutex_lock(&cs->mutex); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 413 | |
| 414 | if (!cs->bcs) |
| 415 | goto f_cs; |
| 416 | if (!cs->inbuf) |
| 417 | goto f_bcs; |
| 418 | |
| 419 | spin_lock_irqsave(&cs->lock, flags); |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 420 | cs->running = 0; |
Tilman Schmidt | 917f508 | 2006-04-10 22:55:00 -0700 | [diff] [blame] | 421 | spin_unlock_irqrestore(&cs->lock, flags); /* event handler and timer are |
| 422 | not rescheduled below */ |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 423 | |
| 424 | tasklet_kill(&cs->event_tasklet); |
| 425 | del_timer_sync(&cs->timer); |
| 426 | |
| 427 | switch (cs->cs_init) { |
| 428 | default: |
Hansjoerg Lipp | 3dda4e3 | 2006-04-22 18:43:00 +0200 | [diff] [blame] | 429 | /* clear device sysfs */ |
| 430 | gigaset_free_dev_sysfs(cs); |
| 431 | |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 432 | gigaset_if_free(cs); |
| 433 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 434 | gig_dbg(DEBUG_INIT, "clearing hw"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 435 | cs->ops->freecshw(cs); |
| 436 | |
| 437 | //FIXME cmdbuf |
| 438 | |
| 439 | /* fall through */ |
| 440 | case 2: /* error in initcshw */ |
| 441 | /* Deregister from LL */ |
| 442 | make_invalid(cs, VALID_ID); |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 443 | gig_dbg(DEBUG_INIT, "clearing iif"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 444 | gigaset_i4l_cmd(cs, ISDN_STAT_UNLOAD); |
| 445 | |
| 446 | /* fall through */ |
| 447 | case 1: /* error when regestering to LL */ |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 448 | gig_dbg(DEBUG_INIT, "clearing at_state"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 449 | clear_at_state(&cs->at_state); |
| 450 | dealloc_at_states(cs); |
| 451 | |
| 452 | /* fall through */ |
| 453 | case 0: /* error in one call to initbcs */ |
| 454 | for (i = 0; i < cs->channels; ++i) { |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 455 | gig_dbg(DEBUG_INIT, "clearing bcs[%d]", i); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 456 | gigaset_freebcs(cs->bcs + i); |
| 457 | } |
| 458 | |
| 459 | clear_events(cs); |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 460 | gig_dbg(DEBUG_INIT, "freeing inbuf"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 461 | kfree(cs->inbuf); |
| 462 | } |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 463 | f_bcs: gig_dbg(DEBUG_INIT, "freeing bcs[]"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 464 | kfree(cs->bcs); |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 465 | f_cs: gig_dbg(DEBUG_INIT, "freeing cs"); |
Tilman Schmidt | abfd1dc | 2006-04-10 22:55:12 -0700 | [diff] [blame] | 466 | mutex_unlock(&cs->mutex); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 467 | free_cs(cs); |
| 468 | } |
| 469 | EXPORT_SYMBOL_GPL(gigaset_freecs); |
| 470 | |
| 471 | void gigaset_at_init(struct at_state_t *at_state, struct bc_state *bcs, |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 472 | struct cardstate *cs, int cid) |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 473 | { |
| 474 | int i; |
| 475 | |
| 476 | INIT_LIST_HEAD(&at_state->list); |
| 477 | at_state->waiting = 0; |
| 478 | at_state->getstring = 0; |
| 479 | at_state->pending_commands = 0; |
| 480 | at_state->timer_expires = 0; |
| 481 | at_state->timer_active = 0; |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 482 | at_state->timer_index = 0; |
| 483 | at_state->seq_index = 0; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 484 | at_state->ConState = 0; |
| 485 | for (i = 0; i < STR_NUM; ++i) |
| 486 | at_state->str_var[i] = NULL; |
| 487 | at_state->int_var[VAR_ZDLE] = 0; |
| 488 | at_state->int_var[VAR_ZCTP] = -1; |
| 489 | at_state->int_var[VAR_ZSAU] = ZSAU_NULL; |
| 490 | at_state->cs = cs; |
| 491 | at_state->bcs = bcs; |
| 492 | at_state->cid = cid; |
| 493 | if (!cid) |
| 494 | at_state->replystruct = cs->tabnocid; |
| 495 | else |
| 496 | at_state->replystruct = cs->tabcid; |
| 497 | } |
| 498 | |
| 499 | |
| 500 | static void gigaset_inbuf_init(struct inbuf_t *inbuf, struct bc_state *bcs, |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 501 | struct cardstate *cs, int inputstate) |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 502 | /* inbuf->read must be allocated before! */ |
| 503 | { |
| 504 | atomic_set(&inbuf->head, 0); |
| 505 | atomic_set(&inbuf->tail, 0); |
| 506 | inbuf->cs = cs; |
| 507 | inbuf->bcs = bcs; /*base driver: NULL*/ |
| 508 | inbuf->rcvbuf = NULL; //FIXME |
| 509 | inbuf->inputstate = inputstate; |
| 510 | } |
| 511 | |
Tilman Schmidt | 714e823 | 2006-04-10 22:55:09 -0700 | [diff] [blame] | 512 | /* append received bytes to inbuf */ |
| 513 | int gigaset_fill_inbuf(struct inbuf_t *inbuf, const unsigned char *src, |
| 514 | unsigned numbytes) |
| 515 | { |
| 516 | unsigned n, head, tail, bytesleft; |
| 517 | |
| 518 | gig_dbg(DEBUG_INTR, "received %u bytes", numbytes); |
| 519 | |
| 520 | if (!numbytes) |
| 521 | return 0; |
| 522 | |
| 523 | bytesleft = numbytes; |
| 524 | tail = atomic_read(&inbuf->tail); |
| 525 | head = atomic_read(&inbuf->head); |
| 526 | gig_dbg(DEBUG_INTR, "buffer state: %u -> %u", head, tail); |
| 527 | |
| 528 | while (bytesleft) { |
| 529 | if (head > tail) |
| 530 | n = head - 1 - tail; |
| 531 | else if (head == 0) |
| 532 | n = (RBUFSIZE-1) - tail; |
| 533 | else |
| 534 | n = RBUFSIZE - tail; |
| 535 | if (!n) { |
| 536 | dev_err(inbuf->cs->dev, |
| 537 | "buffer overflow (%u bytes lost)", bytesleft); |
| 538 | break; |
| 539 | } |
| 540 | if (n > bytesleft) |
| 541 | n = bytesleft; |
| 542 | memcpy(inbuf->data + tail, src, n); |
| 543 | bytesleft -= n; |
| 544 | tail = (tail + n) % RBUFSIZE; |
| 545 | src += n; |
| 546 | } |
| 547 | gig_dbg(DEBUG_INTR, "setting tail to %u", tail); |
| 548 | atomic_set(&inbuf->tail, tail); |
| 549 | return numbytes != bytesleft; |
| 550 | } |
| 551 | EXPORT_SYMBOL_GPL(gigaset_fill_inbuf); |
| 552 | |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 553 | /* Initialize the b-channel structure */ |
| 554 | static struct bc_state *gigaset_initbcs(struct bc_state *bcs, |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 555 | struct cardstate *cs, int channel) |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 556 | { |
| 557 | int i; |
| 558 | |
| 559 | bcs->tx_skb = NULL; //FIXME -> hw part |
| 560 | |
| 561 | skb_queue_head_init(&bcs->squeue); |
| 562 | |
| 563 | bcs->corrupted = 0; |
| 564 | bcs->trans_down = 0; |
| 565 | bcs->trans_up = 0; |
| 566 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 567 | gig_dbg(DEBUG_INIT, "setting up bcs[%d]->at_state", channel); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 568 | gigaset_at_init(&bcs->at_state, bcs, cs, -1); |
| 569 | |
| 570 | bcs->rcvbytes = 0; |
| 571 | |
| 572 | #ifdef CONFIG_GIGASET_DEBUG |
| 573 | bcs->emptycount = 0; |
| 574 | #endif |
| 575 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 576 | gig_dbg(DEBUG_INIT, "allocating bcs[%d]->skb", channel); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 577 | bcs->fcs = PPP_INITFCS; |
| 578 | bcs->inputstate = 0; |
| 579 | if (cs->ignoreframes) { |
| 580 | bcs->inputstate |= INS_skip_frame; |
| 581 | bcs->skb = NULL; |
| 582 | } else if ((bcs->skb = dev_alloc_skb(SBUFSIZE + HW_HDR_LEN)) != NULL) |
| 583 | skb_reserve(bcs->skb, HW_HDR_LEN); |
| 584 | else { |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 585 | warn("could not allocate skb"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 586 | bcs->inputstate |= INS_skip_frame; |
| 587 | } |
| 588 | |
| 589 | bcs->channel = channel; |
| 590 | bcs->cs = cs; |
| 591 | |
| 592 | bcs->chstate = 0; |
| 593 | bcs->use_count = 1; |
| 594 | bcs->busy = 0; |
| 595 | bcs->ignore = cs->ignoreframes; |
| 596 | |
| 597 | for (i = 0; i < AT_NUM; ++i) |
| 598 | bcs->commands[i] = NULL; |
| 599 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 600 | gig_dbg(DEBUG_INIT, " setting up bcs[%d]->hw", channel); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 601 | if (cs->ops->initbcshw(bcs)) |
| 602 | return bcs; |
| 603 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 604 | gig_dbg(DEBUG_INIT, " failed"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 605 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 606 | gig_dbg(DEBUG_INIT, " freeing bcs[%d]->skb", channel); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 607 | if (bcs->skb) |
| 608 | dev_kfree_skb(bcs->skb); |
| 609 | |
| 610 | return NULL; |
| 611 | } |
| 612 | |
| 613 | /* gigaset_initcs |
| 614 | * Allocate and initialize cardstate structure for Gigaset driver |
| 615 | * Calls hardware dependent gigaset_initcshw() function |
| 616 | * Calls B channel initialization function gigaset_initbcs() for each B channel |
| 617 | * parameters: |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 618 | * drv hardware driver the device belongs to |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 619 | * channels number of B channels supported by device |
Tilman Schmidt | 917f508 | 2006-04-10 22:55:00 -0700 | [diff] [blame] | 620 | * onechannel !=0: B channel data and AT commands share one |
| 621 | * communication channel |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 622 | * ==0: B channels have separate communication channels |
| 623 | * ignoreframes number of frames to ignore after setting up B channel |
| 624 | * cidmode !=0: start in CallID mode |
| 625 | * modulename name of driver module (used for I4L registration) |
| 626 | * return value: |
| 627 | * pointer to cardstate structure |
| 628 | */ |
| 629 | struct cardstate *gigaset_initcs(struct gigaset_driver *drv, int channels, |
| 630 | int onechannel, int ignoreframes, |
| 631 | int cidmode, const char *modulename) |
| 632 | { |
| 633 | struct cardstate *cs = NULL; |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 634 | unsigned long flags; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 635 | int i; |
| 636 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 637 | gig_dbg(DEBUG_INIT, "allocating cs"); |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 638 | if (!(cs = alloc_cs(drv))) { |
| 639 | err("maximum number of devices exceeded"); |
| 640 | return NULL; |
| 641 | } |
| 642 | mutex_init(&cs->mutex); |
| 643 | mutex_lock(&cs->mutex); |
| 644 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 645 | gig_dbg(DEBUG_INIT, "allocating bcs[0..%d]", channels - 1); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 646 | cs->bcs = kmalloc(channels * sizeof(struct bc_state), GFP_KERNEL); |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 647 | if (!cs->bcs) { |
| 648 | err("out of memory"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 649 | goto error; |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 650 | } |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 651 | gig_dbg(DEBUG_INIT, "allocating inbuf"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 652 | cs->inbuf = kmalloc(sizeof(struct inbuf_t), GFP_KERNEL); |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 653 | if (!cs->inbuf) { |
| 654 | err("out of memory"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 655 | goto error; |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 656 | } |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 657 | |
| 658 | cs->cs_init = 0; |
| 659 | cs->channels = channels; |
| 660 | cs->onechannel = onechannel; |
| 661 | cs->ignoreframes = ignoreframes; |
| 662 | INIT_LIST_HEAD(&cs->temp_at_states); |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 663 | cs->running = 0; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 664 | init_timer(&cs->timer); /* clear next & prev */ |
| 665 | spin_lock_init(&cs->ev_lock); |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 666 | cs->ev_tail = 0; |
| 667 | cs->ev_head = 0; |
Tilman Schmidt | abfd1dc | 2006-04-10 22:55:12 -0700 | [diff] [blame] | 668 | |
Tilman Schmidt | 917f508 | 2006-04-10 22:55:00 -0700 | [diff] [blame] | 669 | tasklet_init(&cs->event_tasklet, &gigaset_handle_event, |
| 670 | (unsigned long) cs); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 671 | atomic_set(&cs->commands_pending, 0); |
| 672 | cs->cur_at_seq = 0; |
| 673 | cs->gotfwver = -1; |
| 674 | cs->open_count = 0; |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 675 | cs->dev = NULL; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 676 | cs->tty = NULL; |
Greg Kroah-Hartman | 01107d3 | 2006-08-07 22:19:37 -0700 | [diff] [blame] | 677 | cs->tty_dev = NULL; |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 678 | cs->cidmode = cidmode != 0; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 679 | |
| 680 | //if(onechannel) { //FIXME |
| 681 | cs->tabnocid = gigaset_tab_nocid_m10x; |
| 682 | cs->tabcid = gigaset_tab_cid_m10x; |
| 683 | //} else { |
| 684 | // cs->tabnocid = gigaset_tab_nocid; |
| 685 | // cs->tabcid = gigaset_tab_cid; |
| 686 | //} |
| 687 | |
| 688 | init_waitqueue_head(&cs->waitqueue); |
| 689 | cs->waiting = 0; |
| 690 | |
| 691 | atomic_set(&cs->mode, M_UNKNOWN); |
| 692 | atomic_set(&cs->mstate, MS_UNINITIALIZED); |
| 693 | |
| 694 | for (i = 0; i < channels; ++i) { |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 695 | gig_dbg(DEBUG_INIT, "setting up bcs[%d].read", i); |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 696 | if (!gigaset_initbcs(cs->bcs + i, cs, i)) { |
| 697 | err("could not allocate channel %d data", i); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 698 | goto error; |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 699 | } |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 700 | } |
| 701 | |
| 702 | ++cs->cs_init; |
| 703 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 704 | gig_dbg(DEBUG_INIT, "setting up at_state"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 705 | spin_lock_init(&cs->lock); |
| 706 | gigaset_at_init(&cs->at_state, NULL, cs, 0); |
| 707 | cs->dle = 0; |
| 708 | cs->cbytes = 0; |
| 709 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 710 | gig_dbg(DEBUG_INIT, "setting up inbuf"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 711 | if (onechannel) { //FIXME distinction necessary? |
| 712 | gigaset_inbuf_init(cs->inbuf, cs->bcs, cs, INS_command); |
| 713 | } else |
| 714 | gigaset_inbuf_init(cs->inbuf, NULL, cs, INS_command); |
| 715 | |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 716 | cs->connected = 0; |
| 717 | cs->isdn_up = 0; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 718 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 719 | gig_dbg(DEBUG_INIT, "setting up cmdbuf"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 720 | cs->cmdbuf = cs->lastcmdbuf = NULL; |
| 721 | spin_lock_init(&cs->cmdlock); |
| 722 | cs->curlen = 0; |
| 723 | cs->cmdbytes = 0; |
| 724 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 725 | gig_dbg(DEBUG_INIT, "setting up iif"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 726 | if (!gigaset_register_to_LL(cs, modulename)) { |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 727 | err("register_isdn failed"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 728 | goto error; |
| 729 | } |
| 730 | |
| 731 | make_valid(cs, VALID_ID); |
| 732 | ++cs->cs_init; |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 733 | gig_dbg(DEBUG_INIT, "setting up hw"); |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 734 | if (!cs->ops->initcshw(cs)) { |
| 735 | err("could not allocate device specific data"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 736 | goto error; |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 737 | } |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 738 | |
| 739 | ++cs->cs_init; |
| 740 | |
| 741 | gigaset_if_init(cs); |
| 742 | |
Hansjoerg Lipp | 3dda4e3 | 2006-04-22 18:43:00 +0200 | [diff] [blame] | 743 | /* set up device sysfs */ |
| 744 | gigaset_init_dev_sysfs(cs); |
| 745 | |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 746 | spin_lock_irqsave(&cs->lock, flags); |
| 747 | cs->running = 1; |
| 748 | spin_unlock_irqrestore(&cs->lock, flags); |
Tilman Schmidt | ec81b5e6 | 2006-04-10 22:55:03 -0700 | [diff] [blame] | 749 | setup_timer(&cs->timer, timer_tick, (unsigned long) cs); |
| 750 | cs->timer.expires = jiffies + msecs_to_jiffies(GIG_TICK); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 751 | /* FIXME: can jiffies increase too much until the timer is added? |
| 752 | * Same problem(?) with mod_timer() in timer_tick(). */ |
| 753 | add_timer(&cs->timer); |
| 754 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 755 | gig_dbg(DEBUG_INIT, "cs initialized"); |
Tilman Schmidt | abfd1dc | 2006-04-10 22:55:12 -0700 | [diff] [blame] | 756 | mutex_unlock(&cs->mutex); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 757 | return cs; |
| 758 | |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 759 | error: |
| 760 | mutex_unlock(&cs->mutex); |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 761 | gig_dbg(DEBUG_INIT, "failed"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 762 | gigaset_freecs(cs); |
| 763 | return NULL; |
| 764 | } |
| 765 | EXPORT_SYMBOL_GPL(gigaset_initcs); |
| 766 | |
Tilman Schmidt | 73a8881 | 2006-04-22 02:35:30 -0700 | [diff] [blame] | 767 | /* ReInitialize the b-channel structure on hangup */ |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 768 | void gigaset_bcs_reinit(struct bc_state *bcs) |
| 769 | { |
| 770 | struct sk_buff *skb; |
| 771 | struct cardstate *cs = bcs->cs; |
| 772 | unsigned long flags; |
| 773 | |
| 774 | while ((skb = skb_dequeue(&bcs->squeue)) != NULL) |
| 775 | dev_kfree_skb(skb); |
| 776 | |
Tilman Schmidt | 917f508 | 2006-04-10 22:55:00 -0700 | [diff] [blame] | 777 | spin_lock_irqsave(&cs->lock, flags); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 778 | clear_at_state(&bcs->at_state); |
| 779 | bcs->at_state.ConState = 0; |
| 780 | bcs->at_state.timer_active = 0; |
| 781 | bcs->at_state.timer_expires = 0; |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 782 | bcs->at_state.cid = -1; /* No CID defined */ |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 783 | spin_unlock_irqrestore(&cs->lock, flags); |
| 784 | |
| 785 | bcs->inputstate = 0; |
| 786 | |
| 787 | #ifdef CONFIG_GIGASET_DEBUG |
| 788 | bcs->emptycount = 0; |
| 789 | #endif |
| 790 | |
| 791 | bcs->fcs = PPP_INITFCS; |
| 792 | bcs->chstate = 0; |
| 793 | |
| 794 | bcs->ignore = cs->ignoreframes; |
| 795 | if (bcs->ignore) |
| 796 | bcs->inputstate |= INS_skip_frame; |
| 797 | |
| 798 | |
| 799 | cs->ops->reinitbcshw(bcs); |
| 800 | } |
| 801 | |
| 802 | static void cleanup_cs(struct cardstate *cs) |
| 803 | { |
| 804 | struct cmdbuf_t *cb, *tcb; |
| 805 | int i; |
| 806 | unsigned long flags; |
| 807 | |
| 808 | spin_lock_irqsave(&cs->lock, flags); |
| 809 | |
| 810 | atomic_set(&cs->mode, M_UNKNOWN); |
| 811 | atomic_set(&cs->mstate, MS_UNINITIALIZED); |
| 812 | |
| 813 | clear_at_state(&cs->at_state); |
| 814 | dealloc_at_states(cs); |
| 815 | free_strings(&cs->at_state); |
| 816 | gigaset_at_init(&cs->at_state, NULL, cs, 0); |
| 817 | |
| 818 | kfree(cs->inbuf->rcvbuf); |
| 819 | cs->inbuf->rcvbuf = NULL; |
| 820 | cs->inbuf->inputstate = INS_command; |
| 821 | atomic_set(&cs->inbuf->head, 0); |
| 822 | atomic_set(&cs->inbuf->tail, 0); |
| 823 | |
| 824 | cb = cs->cmdbuf; |
| 825 | while (cb) { |
| 826 | tcb = cb; |
| 827 | cb = cb->next; |
| 828 | kfree(tcb); |
| 829 | } |
| 830 | cs->cmdbuf = cs->lastcmdbuf = NULL; |
| 831 | cs->curlen = 0; |
| 832 | cs->cmdbytes = 0; |
| 833 | cs->gotfwver = -1; |
| 834 | cs->dle = 0; |
| 835 | cs->cur_at_seq = 0; |
| 836 | atomic_set(&cs->commands_pending, 0); |
| 837 | cs->cbytes = 0; |
| 838 | |
| 839 | spin_unlock_irqrestore(&cs->lock, flags); |
| 840 | |
| 841 | for (i = 0; i < cs->channels; ++i) { |
| 842 | gigaset_freebcs(cs->bcs + i); |
| 843 | if (!gigaset_initbcs(cs->bcs + i, cs, i)) |
| 844 | break; //FIXME error handling |
| 845 | } |
| 846 | |
| 847 | if (cs->waiting) { |
| 848 | cs->cmd_result = -ENODEV; |
| 849 | cs->waiting = 0; |
| 850 | wake_up_interruptible(&cs->waitqueue); |
| 851 | } |
| 852 | } |
| 853 | |
| 854 | |
| 855 | int gigaset_start(struct cardstate *cs) |
| 856 | { |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 857 | unsigned long flags; |
| 858 | |
Tilman Schmidt | abfd1dc | 2006-04-10 22:55:12 -0700 | [diff] [blame] | 859 | if (mutex_lock_interruptible(&cs->mutex)) |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 860 | return 0; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 861 | |
Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 862 | spin_lock_irqsave(&cs->lock, flags); |
| 863 | cs->connected = 1; |
| 864 | spin_unlock_irqrestore(&cs->lock, flags); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 865 | |
| 866 | if (atomic_read(&cs->mstate) != MS_LOCKED) { |
| 867 | cs->ops->set_modem_ctrl(cs, 0, TIOCM_DTR|TIOCM_RTS); |
| 868 | cs->ops->baud_rate(cs, B115200); |
| 869 | cs->ops->set_line_ctrl(cs, CS8); |
| 870 | cs->control_state = TIOCM_DTR|TIOCM_RTS; |
| 871 | } else { |
| 872 | //FIXME use some saved values? |
| 873 | } |
| 874 | |
| 875 | cs->waiting = 1; |
| 876 | |
| 877 | if (!gigaset_add_event(cs, &cs->at_state, EV_START, NULL, 0, NULL)) { |
| 878 | cs->waiting = 0; |
| 879 | //FIXME what should we do? |
| 880 | goto error; |
| 881 | } |
| 882 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 883 | gig_dbg(DEBUG_CMD, "scheduling START"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 884 | gigaset_schedule_event(cs); |
| 885 | |
| 886 | wait_event(cs->waitqueue, !cs->waiting); |
| 887 | |
Tilman Schmidt | abfd1dc | 2006-04-10 22:55:12 -0700 | [diff] [blame] | 888 | mutex_unlock(&cs->mutex); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 889 | return 1; |
| 890 | |
| 891 | error: |
Tilman Schmidt | abfd1dc | 2006-04-10 22:55:12 -0700 | [diff] [blame] | 892 | mutex_unlock(&cs->mutex); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 893 | return 0; |
| 894 | } |
| 895 | EXPORT_SYMBOL_GPL(gigaset_start); |
| 896 | |
| 897 | void gigaset_shutdown(struct cardstate *cs) |
| 898 | { |
Tilman Schmidt | abfd1dc | 2006-04-10 22:55:12 -0700 | [diff] [blame] | 899 | mutex_lock(&cs->mutex); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 900 | |
| 901 | cs->waiting = 1; |
| 902 | |
| 903 | if (!gigaset_add_event(cs, &cs->at_state, EV_SHUTDOWN, NULL, 0, NULL)) { |
| 904 | //FIXME what should we do? |
| 905 | goto exit; |
| 906 | } |
| 907 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 908 | gig_dbg(DEBUG_CMD, "scheduling SHUTDOWN"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 909 | gigaset_schedule_event(cs); |
| 910 | |
| 911 | if (wait_event_interruptible(cs->waitqueue, !cs->waiting)) { |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 912 | warn("%s: aborted", __func__); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 913 | //FIXME |
| 914 | } |
| 915 | |
| 916 | if (atomic_read(&cs->mstate) != MS_LOCKED) { |
| 917 | //FIXME? |
| 918 | //gigaset_baud_rate(cs, B115200); |
| 919 | //gigaset_set_line_ctrl(cs, CS8); |
| 920 | //gigaset_set_modem_ctrl(cs, TIOCM_DTR|TIOCM_RTS, 0); |
| 921 | //cs->control_state = 0; |
| 922 | } else { |
| 923 | //FIXME use some saved values? |
| 924 | } |
| 925 | |
| 926 | cleanup_cs(cs); |
| 927 | |
| 928 | exit: |
Tilman Schmidt | abfd1dc | 2006-04-10 22:55:12 -0700 | [diff] [blame] | 929 | mutex_unlock(&cs->mutex); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 930 | } |
| 931 | EXPORT_SYMBOL_GPL(gigaset_shutdown); |
| 932 | |
| 933 | void gigaset_stop(struct cardstate *cs) |
| 934 | { |
Tilman Schmidt | abfd1dc | 2006-04-10 22:55:12 -0700 | [diff] [blame] | 935 | mutex_lock(&cs->mutex); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 936 | |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 937 | cs->waiting = 1; |
| 938 | |
| 939 | if (!gigaset_add_event(cs, &cs->at_state, EV_STOP, NULL, 0, NULL)) { |
| 940 | //FIXME what should we do? |
| 941 | goto exit; |
| 942 | } |
| 943 | |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 944 | gig_dbg(DEBUG_CMD, "scheduling STOP"); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 945 | gigaset_schedule_event(cs); |
| 946 | |
| 947 | if (wait_event_interruptible(cs->waitqueue, !cs->waiting)) { |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 948 | warn("%s: aborted", __func__); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 949 | //FIXME |
| 950 | } |
| 951 | |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 952 | cleanup_cs(cs); |
| 953 | |
| 954 | exit: |
Tilman Schmidt | abfd1dc | 2006-04-10 22:55:12 -0700 | [diff] [blame] | 955 | mutex_unlock(&cs->mutex); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 956 | } |
| 957 | EXPORT_SYMBOL_GPL(gigaset_stop); |
| 958 | |
| 959 | static LIST_HEAD(drivers); |
Ingo Molnar | 34af946 | 2006-06-27 02:53:55 -0700 | [diff] [blame] | 960 | static DEFINE_SPINLOCK(driver_lock); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 961 | |
| 962 | struct cardstate *gigaset_get_cs_by_id(int id) |
| 963 | { |
| 964 | unsigned long flags; |
| 965 | static struct cardstate *ret = NULL; |
| 966 | static struct cardstate *cs; |
| 967 | struct gigaset_driver *drv; |
| 968 | unsigned i; |
| 969 | |
| 970 | spin_lock_irqsave(&driver_lock, flags); |
| 971 | list_for_each_entry(drv, &drivers, list) { |
| 972 | spin_lock(&drv->lock); |
| 973 | for (i = 0; i < drv->minors; ++i) { |
| 974 | if (drv->flags[i] & VALID_ID) { |
| 975 | cs = drv->cs + i; |
| 976 | if (cs->myid == id) |
| 977 | ret = cs; |
| 978 | } |
| 979 | if (ret) |
| 980 | break; |
| 981 | } |
| 982 | spin_unlock(&drv->lock); |
| 983 | if (ret) |
| 984 | break; |
| 985 | } |
| 986 | spin_unlock_irqrestore(&driver_lock, flags); |
| 987 | return ret; |
| 988 | } |
| 989 | |
| 990 | void gigaset_debugdrivers(void) |
| 991 | { |
| 992 | unsigned long flags; |
| 993 | static struct cardstate *cs; |
| 994 | struct gigaset_driver *drv; |
| 995 | unsigned i; |
| 996 | |
| 997 | spin_lock_irqsave(&driver_lock, flags); |
| 998 | list_for_each_entry(drv, &drivers, list) { |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 999 | gig_dbg(DEBUG_DRIVER, "driver %p", drv); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1000 | spin_lock(&drv->lock); |
| 1001 | for (i = 0; i < drv->minors; ++i) { |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 1002 | gig_dbg(DEBUG_DRIVER, " index %u", i); |
| 1003 | gig_dbg(DEBUG_DRIVER, " flags 0x%02x", |
| 1004 | drv->flags[i]); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1005 | cs = drv->cs + i; |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 1006 | gig_dbg(DEBUG_DRIVER, " cardstate %p", cs); |
| 1007 | gig_dbg(DEBUG_DRIVER, " minor_index %u", |
| 1008 | cs->minor_index); |
| 1009 | gig_dbg(DEBUG_DRIVER, " driver %p", cs->driver); |
| 1010 | gig_dbg(DEBUG_DRIVER, " i4l id %d", cs->myid); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1011 | } |
| 1012 | spin_unlock(&drv->lock); |
| 1013 | } |
| 1014 | spin_unlock_irqrestore(&driver_lock, flags); |
| 1015 | } |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1016 | |
Adrian Bunk | 8ca445d | 2006-04-10 22:55:18 -0700 | [diff] [blame] | 1017 | static struct cardstate *gigaset_get_cs_by_minor(unsigned minor) |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1018 | { |
| 1019 | unsigned long flags; |
| 1020 | static struct cardstate *ret = NULL; |
| 1021 | struct gigaset_driver *drv; |
| 1022 | unsigned index; |
| 1023 | |
| 1024 | spin_lock_irqsave(&driver_lock, flags); |
| 1025 | list_for_each_entry(drv, &drivers, list) { |
| 1026 | if (minor < drv->minor || minor >= drv->minor + drv->minors) |
| 1027 | continue; |
| 1028 | index = minor - drv->minor; |
| 1029 | spin_lock(&drv->lock); |
| 1030 | if (drv->flags[index] & VALID_MINOR) |
| 1031 | ret = drv->cs + index; |
| 1032 | spin_unlock(&drv->lock); |
| 1033 | if (ret) |
| 1034 | break; |
| 1035 | } |
| 1036 | spin_unlock_irqrestore(&driver_lock, flags); |
| 1037 | return ret; |
| 1038 | } |
| 1039 | |
Adrian Bunk | 8ca445d | 2006-04-10 22:55:18 -0700 | [diff] [blame] | 1040 | struct cardstate *gigaset_get_cs_by_tty(struct tty_struct *tty) |
| 1041 | { |
| 1042 | if (tty->index < 0 || tty->index >= tty->driver->num) |
| 1043 | return NULL; |
| 1044 | return gigaset_get_cs_by_minor(tty->index + tty->driver->minor_start); |
| 1045 | } |
| 1046 | |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1047 | void gigaset_freedriver(struct gigaset_driver *drv) |
| 1048 | { |
| 1049 | unsigned long flags; |
| 1050 | |
| 1051 | spin_lock_irqsave(&driver_lock, flags); |
| 1052 | list_del(&drv->list); |
| 1053 | spin_unlock_irqrestore(&driver_lock, flags); |
| 1054 | |
| 1055 | gigaset_if_freedriver(drv); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1056 | |
| 1057 | kfree(drv->cs); |
| 1058 | kfree(drv->flags); |
| 1059 | kfree(drv); |
| 1060 | } |
| 1061 | EXPORT_SYMBOL_GPL(gigaset_freedriver); |
| 1062 | |
| 1063 | /* gigaset_initdriver |
| 1064 | * Allocate and initialize gigaset_driver structure. Initialize interface. |
| 1065 | * parameters: |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 1066 | * minor First minor number |
| 1067 | * minors Number of minors this driver can handle |
| 1068 | * procname Name of the driver |
| 1069 | * devname Name of the device files (prefix without minor number) |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1070 | * return value: |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 1071 | * Pointer to the gigaset_driver structure on success, NULL on failure. |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1072 | */ |
| 1073 | struct gigaset_driver *gigaset_initdriver(unsigned minor, unsigned minors, |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 1074 | const char *procname, |
| 1075 | const char *devname, |
Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 1076 | const struct gigaset_ops *ops, |
| 1077 | struct module *owner) |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1078 | { |
| 1079 | struct gigaset_driver *drv; |
| 1080 | unsigned long flags; |
| 1081 | unsigned i; |
| 1082 | |
| 1083 | drv = kmalloc(sizeof *drv, GFP_KERNEL); |
| 1084 | if (!drv) |
| 1085 | return NULL; |
Adrian Bunk | f4675c7 | 2006-04-10 22:55:19 -0700 | [diff] [blame] | 1086 | |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1087 | drv->have_tty = 0; |
| 1088 | drv->minor = minor; |
| 1089 | drv->minors = minors; |
| 1090 | spin_lock_init(&drv->lock); |
| 1091 | drv->blocked = 0; |
| 1092 | drv->ops = ops; |
| 1093 | drv->owner = owner; |
| 1094 | INIT_LIST_HEAD(&drv->list); |
| 1095 | |
| 1096 | drv->cs = kmalloc(minors * sizeof *drv->cs, GFP_KERNEL); |
| 1097 | if (!drv->cs) |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 1098 | goto error; |
Adrian Bunk | f4675c7 | 2006-04-10 22:55:19 -0700 | [diff] [blame] | 1099 | |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1100 | drv->flags = kmalloc(minors * sizeof *drv->flags, GFP_KERNEL); |
| 1101 | if (!drv->flags) |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 1102 | goto error; |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1103 | |
| 1104 | for (i = 0; i < minors; ++i) { |
| 1105 | drv->flags[i] = 0; |
| 1106 | drv->cs[i].driver = drv; |
| 1107 | drv->cs[i].ops = drv->ops; |
| 1108 | drv->cs[i].minor_index = i; |
| 1109 | } |
| 1110 | |
Greg Kroah-Hartman | f4eaa37 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 1111 | gigaset_if_initdriver(drv, procname, devname); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1112 | |
| 1113 | spin_lock_irqsave(&driver_lock, flags); |
| 1114 | list_add(&drv->list, &drivers); |
| 1115 | spin_unlock_irqrestore(&driver_lock, flags); |
| 1116 | |
| 1117 | return drv; |
| 1118 | |
Tilman Schmidt | e702ff0 | 2007-01-26 00:56:56 -0800 | [diff] [blame] | 1119 | error: |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1120 | kfree(drv->cs); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1121 | kfree(drv); |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1122 | return NULL; |
| 1123 | } |
| 1124 | EXPORT_SYMBOL_GPL(gigaset_initdriver); |
| 1125 | |
Hansjoerg Lipp | 6fd5ea6 | 2006-03-26 01:38:29 -0800 | [diff] [blame] | 1126 | /* For drivers without fixed assignment device<->cardstate (usb) */ |
| 1127 | struct cardstate *gigaset_getunassignedcs(struct gigaset_driver *drv) |
| 1128 | { |
| 1129 | unsigned long flags; |
| 1130 | struct cardstate *cs = NULL; |
| 1131 | unsigned i; |
| 1132 | |
| 1133 | spin_lock_irqsave(&drv->lock, flags); |
| 1134 | if (drv->blocked) |
| 1135 | goto exit; |
| 1136 | for (i = 0; i < drv->minors; ++i) { |
| 1137 | if ((drv->flags[i] & VALID_MINOR) && |
| 1138 | !(drv->flags[i] & ASSIGNED)) { |
| 1139 | drv->flags[i] |= ASSIGNED; |
| 1140 | cs = drv->cs + i; |
| 1141 | break; |
| 1142 | } |
| 1143 | } |
| 1144 | exit: |
| 1145 | spin_unlock_irqrestore(&drv->lock, flags); |
| 1146 | return cs; |
| 1147 | } |
| 1148 | EXPORT_SYMBOL_GPL(gigaset_getunassignedcs); |
| 1149 | |
| 1150 | void gigaset_unassign(struct cardstate *cs) |
| 1151 | { |
| 1152 | unsigned long flags; |
| 1153 | unsigned *minor_flags; |
| 1154 | struct gigaset_driver *drv; |
| 1155 | |
| 1156 | if (!cs) |
| 1157 | return; |
| 1158 | drv = cs->driver; |
| 1159 | spin_lock_irqsave(&drv->lock, flags); |
| 1160 | minor_flags = drv->flags + cs->minor_index; |
| 1161 | if (*minor_flags & VALID_MINOR) |
| 1162 | *minor_flags &= ~ASSIGNED; |
| 1163 | spin_unlock_irqrestore(&drv->lock, flags); |
| 1164 | } |
| 1165 | EXPORT_SYMBOL_GPL(gigaset_unassign); |
| 1166 | |
| 1167 | void gigaset_blockdriver(struct gigaset_driver *drv) |
| 1168 | { |
| 1169 | unsigned long flags; |
| 1170 | spin_lock_irqsave(&drv->lock, flags); |
| 1171 | drv->blocked = 1; |
| 1172 | spin_unlock_irqrestore(&drv->lock, flags); |
| 1173 | } |
| 1174 | EXPORT_SYMBOL_GPL(gigaset_blockdriver); |
| 1175 | |
| 1176 | static int __init gigaset_init_module(void) |
| 1177 | { |
| 1178 | /* in accordance with the principle of least astonishment, |
| 1179 | * setting the 'debug' parameter to 1 activates a sensible |
| 1180 | * set of default debug levels |
| 1181 | */ |
| 1182 | if (gigaset_debuglevel == 1) |
| 1183 | gigaset_debuglevel = DEBUG_DEFAULT; |
| 1184 | |
| 1185 | info(DRIVER_AUTHOR); |
| 1186 | info(DRIVER_DESC); |
| 1187 | return 0; |
| 1188 | } |
| 1189 | |
| 1190 | static void __exit gigaset_exit_module(void) |
| 1191 | { |
| 1192 | } |
| 1193 | |
| 1194 | module_init(gigaset_init_module); |
| 1195 | module_exit(gigaset_exit_module); |
| 1196 | |
| 1197 | MODULE_AUTHOR(DRIVER_AUTHOR); |
| 1198 | MODULE_DESCRIPTION(DRIVER_DESC); |
| 1199 | |
| 1200 | MODULE_LICENSE("GPL"); |