Commit | Line | Data |
---|---|---|
ee8a4b7f HL |
1 | /* |
2 | * interface to user space for the gigaset driver | |
3 | * | |
4 | * Copyright (c) 2004 by Hansjoerg Lipp <hjlipp@web.de> | |
5 | * | |
6 | * ===================================================================== | |
7 | * This program is free software; you can redistribute it and/or | |
8 | * modify it under the terms of the GNU General Public License as | |
9 | * published by the Free Software Foundation; either version 2 of | |
10 | * the License, or (at your option) any later version. | |
11 | * ===================================================================== | |
ee8a4b7f HL |
12 | */ |
13 | ||
14 | #include "gigaset.h" | |
15 | #include <linux/gigaset_dev.h> | |
ee8a4b7f | 16 | #include <linux/tty_flip.h> |
07a97fe8 | 17 | #include <linux/module.h> |
ee8a4b7f HL |
18 | |
19 | /*** our ioctls ***/ | |
20 | ||
21 | static int if_lock(struct cardstate *cs, int *arg) | |
22 | { | |
23 | int cmd = *arg; | |
24 | ||
784d5858 | 25 | gig_dbg(DEBUG_IF, "%u: if_lock (%d)", cs->minor_index, cmd); |
ee8a4b7f HL |
26 | |
27 | if (cmd > 1) | |
28 | return -EINVAL; | |
29 | ||
30 | if (cmd < 0) { | |
9d4bee2b | 31 | *arg = cs->mstate == MS_LOCKED; |
ee8a4b7f HL |
32 | return 0; |
33 | } | |
34 | ||
9d4bee2b | 35 | if (!cmd && cs->mstate == MS_LOCKED && cs->connected) { |
475be4d8 | 36 | cs->ops->set_modem_ctrl(cs, 0, TIOCM_DTR | TIOCM_RTS); |
ee8a4b7f HL |
37 | cs->ops->baud_rate(cs, B115200); |
38 | cs->ops->set_line_ctrl(cs, CS8); | |
475be4d8 | 39 | cs->control_state = TIOCM_DTR | TIOCM_RTS; |
ee8a4b7f HL |
40 | } |
41 | ||
42 | cs->waiting = 1; | |
43 | if (!gigaset_add_event(cs, &cs->at_state, EV_IF_LOCK, | |
784d5858 | 44 | NULL, cmd, NULL)) { |
ee8a4b7f HL |
45 | cs->waiting = 0; |
46 | return -ENOMEM; | |
47 | } | |
ee8a4b7f HL |
48 | gigaset_schedule_event(cs); |
49 | ||
50 | wait_event(cs->waitqueue, !cs->waiting); | |
51 | ||
52 | if (cs->cmd_result >= 0) { | |
53 | *arg = cs->cmd_result; | |
54 | return 0; | |
55 | } | |
56 | ||
57 | return cs->cmd_result; | |
58 | } | |
59 | ||
60 | static int if_version(struct cardstate *cs, unsigned arg[4]) | |
61 | { | |
62 | static const unsigned version[4] = GIG_VERSION; | |
63 | static const unsigned compat[4] = GIG_COMPAT; | |
64 | unsigned cmd = arg[0]; | |
65 | ||
784d5858 | 66 | gig_dbg(DEBUG_IF, "%u: if_version (%d)", cs->minor_index, cmd); |
ee8a4b7f HL |
67 | |
68 | switch (cmd) { | |
69 | case GIGVER_DRIVER: | |
70 | memcpy(arg, version, sizeof version); | |
71 | return 0; | |
72 | case GIGVER_COMPAT: | |
73 | memcpy(arg, compat, sizeof compat); | |
74 | return 0; | |
75 | case GIGVER_FWBASE: | |
76 | cs->waiting = 1; | |
77 | if (!gigaset_add_event(cs, &cs->at_state, EV_IF_VER, | |
784d5858 | 78 | NULL, 0, arg)) { |
ee8a4b7f HL |
79 | cs->waiting = 0; |
80 | return -ENOMEM; | |
81 | } | |
ee8a4b7f HL |
82 | gigaset_schedule_event(cs); |
83 | ||
84 | wait_event(cs->waitqueue, !cs->waiting); | |
85 | ||
86 | if (cs->cmd_result >= 0) | |
87 | return 0; | |
88 | ||
89 | return cs->cmd_result; | |
90 | default: | |
91 | return -EINVAL; | |
92 | } | |
93 | } | |
94 | ||
95 | static int if_config(struct cardstate *cs, int *arg) | |
96 | { | |
784d5858 | 97 | gig_dbg(DEBUG_IF, "%u: if_config (%d)", cs->minor_index, *arg); |
ee8a4b7f HL |
98 | |
99 | if (*arg != 1) | |
100 | return -EINVAL; | |
101 | ||
9d4bee2b | 102 | if (cs->mstate != MS_LOCKED) |
ee8a4b7f HL |
103 | return -EBUSY; |
104 | ||
69049cc8 | 105 | if (!cs->connected) { |
c8770dca | 106 | pr_err("%s: not connected\n", __func__); |
69049cc8 TS |
107 | return -ENODEV; |
108 | } | |
109 | ||
ee8a4b7f HL |
110 | *arg = 0; |
111 | return gigaset_enterconfigmode(cs); | |
112 | } | |
113 | ||
114 | /*** the terminal driver ***/ | |
ee8a4b7f HL |
115 | |
116 | static int if_open(struct tty_struct *tty, struct file *filp) | |
117 | { | |
118 | struct cardstate *cs; | |
ee8a4b7f | 119 | |
784d5858 TS |
120 | gig_dbg(DEBUG_IF, "%d+%d: %s()", |
121 | tty->driver->minor_start, tty->index, __func__); | |
ee8a4b7f | 122 | |
ee8a4b7f | 123 | cs = gigaset_get_cs_by_tty(tty); |
e468c048 | 124 | if (!cs || !try_module_get(cs->driver->owner)) |
ee8a4b7f HL |
125 | return -ENODEV; |
126 | ||
2f9381e9 PS |
127 | if (mutex_lock_interruptible(&cs->mutex)) { |
128 | module_put(cs->driver->owner); | |
d9ba9c91 | 129 | return -ERESTARTSYS; |
2f9381e9 | 130 | } |
ee8a4b7f HL |
131 | tty->driver_data = cs; |
132 | ||
48a7466f | 133 | ++cs->port.count; |
ee8a4b7f | 134 | |
48a7466f JS |
135 | if (cs->port.count == 1) { |
136 | tty_port_tty_set(&cs->port, tty); | |
d6c53c0e | 137 | cs->port.low_latency = 1; |
ee8a4b7f HL |
138 | } |
139 | ||
abfd1dc7 | 140 | mutex_unlock(&cs->mutex); |
ee8a4b7f HL |
141 | return 0; |
142 | } | |
143 | ||
144 | static void if_close(struct tty_struct *tty, struct file *filp) | |
145 | { | |
fc258f89 | 146 | struct cardstate *cs = tty->driver_data; |
ee8a4b7f | 147 | |
fc258f89 | 148 | if (!cs) { /* happens if we didn't find cs in open */ |
ef37ea34 | 149 | gig_dbg(DEBUG_IF, "%s: no cardstate", __func__); |
ee8a4b7f HL |
150 | return; |
151 | } | |
152 | ||
784d5858 | 153 | gig_dbg(DEBUG_IF, "%u: %s()", cs->minor_index, __func__); |
ee8a4b7f | 154 | |
abfd1dc7 | 155 | mutex_lock(&cs->mutex); |
ee8a4b7f | 156 | |
51370e5b TS |
157 | if (!cs->connected) |
158 | gig_dbg(DEBUG_IF, "not connected"); /* nothing to do */ | |
48a7466f | 159 | else if (!cs->port.count) |
5002779d | 160 | dev_warn(cs->dev, "%s: device not opened\n", __func__); |
48a7466f JS |
161 | else if (!--cs->port.count) |
162 | tty_port_tty_set(&cs->port, NULL); | |
ee8a4b7f | 163 | |
abfd1dc7 | 164 | mutex_unlock(&cs->mutex); |
e468c048 TS |
165 | |
166 | module_put(cs->driver->owner); | |
ee8a4b7f HL |
167 | } |
168 | ||
6caa76b7 | 169 | static int if_ioctl(struct tty_struct *tty, |
784d5858 | 170 | unsigned int cmd, unsigned long arg) |
ee8a4b7f | 171 | { |
fc258f89 | 172 | struct cardstate *cs = tty->driver_data; |
ee8a4b7f HL |
173 | int retval = -ENODEV; |
174 | int int_arg; | |
175 | unsigned char buf[6]; | |
176 | unsigned version[4]; | |
177 | ||
784d5858 | 178 | gig_dbg(DEBUG_IF, "%u: %s(0x%x)", cs->minor_index, __func__, cmd); |
ee8a4b7f | 179 | |
abfd1dc7 | 180 | if (mutex_lock_interruptible(&cs->mutex)) |
d9ba9c91 | 181 | return -ERESTARTSYS; |
ee8a4b7f | 182 | |
51370e5b TS |
183 | if (!cs->connected) { |
184 | gig_dbg(DEBUG_IF, "not connected"); | |
185 | retval = -ENODEV; | |
fc258f89 | 186 | } else { |
ee8a4b7f HL |
187 | retval = 0; |
188 | switch (cmd) { | |
189 | case GIGASET_REDIR: | |
190 | retval = get_user(int_arg, (int __user *) arg); | |
191 | if (retval >= 0) | |
192 | retval = if_lock(cs, &int_arg); | |
193 | if (retval >= 0) | |
194 | retval = put_user(int_arg, (int __user *) arg); | |
195 | break; | |
196 | case GIGASET_CONFIG: | |
197 | retval = get_user(int_arg, (int __user *) arg); | |
198 | if (retval >= 0) | |
199 | retval = if_config(cs, &int_arg); | |
200 | if (retval >= 0) | |
201 | retval = put_user(int_arg, (int __user *) arg); | |
202 | break; | |
203 | case GIGASET_BRKCHARS: | |
ee8a4b7f | 204 | retval = copy_from_user(&buf, |
475be4d8 | 205 | (const unsigned char __user *) arg, 6) |
784d5858 | 206 | ? -EFAULT : 0; |
01371500 TS |
207 | if (retval >= 0) { |
208 | gigaset_dbg_buffer(DEBUG_IF, "GIGASET_BRKCHARS", | |
475be4d8 | 209 | 6, (const unsigned char *) arg); |
ee8a4b7f | 210 | retval = cs->ops->brkchars(cs, buf); |
01371500 | 211 | } |
ee8a4b7f HL |
212 | break; |
213 | case GIGASET_VERSION: | |
917f5085 | 214 | retval = copy_from_user(version, |
475be4d8 | 215 | (unsigned __user *) arg, sizeof version) |
784d5858 | 216 | ? -EFAULT : 0; |
ee8a4b7f HL |
217 | if (retval >= 0) |
218 | retval = if_version(cs, version); | |
219 | if (retval >= 0) | |
917f5085 | 220 | retval = copy_to_user((unsigned __user *) arg, |
784d5858 TS |
221 | version, sizeof version) |
222 | ? -EFAULT : 0; | |
ee8a4b7f | 223 | break; |
784d5858 | 224 | default: |
1528b18f | 225 | gig_dbg(DEBUG_IF, "%s: arg not supported - 0x%04x", |
784d5858 | 226 | __func__, cmd); |
ee8a4b7f HL |
227 | retval = -ENOIOCTLCMD; |
228 | } | |
229 | } | |
230 | ||
abfd1dc7 | 231 | mutex_unlock(&cs->mutex); |
ee8a4b7f HL |
232 | |
233 | return retval; | |
234 | } | |
235 | ||
60b33c13 | 236 | static int if_tiocmget(struct tty_struct *tty) |
ee8a4b7f | 237 | { |
fc258f89 | 238 | struct cardstate *cs = tty->driver_data; |
ee8a4b7f HL |
239 | int retval; |
240 | ||
784d5858 | 241 | gig_dbg(DEBUG_IF, "%u: %s()", cs->minor_index, __func__); |
ee8a4b7f | 242 | |
abfd1dc7 | 243 | if (mutex_lock_interruptible(&cs->mutex)) |
d9ba9c91 | 244 | return -ERESTARTSYS; |
ee8a4b7f | 245 | |
475be4d8 | 246 | retval = cs->control_state & (TIOCM_RTS | TIOCM_DTR); |
ee8a4b7f | 247 | |
abfd1dc7 | 248 | mutex_unlock(&cs->mutex); |
ee8a4b7f HL |
249 | |
250 | return retval; | |
251 | } | |
252 | ||
20b9d177 | 253 | static int if_tiocmset(struct tty_struct *tty, |
784d5858 | 254 | unsigned int set, unsigned int clear) |
ee8a4b7f | 255 | { |
fc258f89 | 256 | struct cardstate *cs = tty->driver_data; |
ee8a4b7f HL |
257 | int retval; |
258 | unsigned mc; | |
259 | ||
784d5858 TS |
260 | gig_dbg(DEBUG_IF, "%u: %s(0x%x, 0x%x)", |
261 | cs->minor_index, __func__, set, clear); | |
ee8a4b7f | 262 | |
abfd1dc7 | 263 | if (mutex_lock_interruptible(&cs->mutex)) |
d9ba9c91 | 264 | return -ERESTARTSYS; |
ee8a4b7f | 265 | |
69049cc8 | 266 | if (!cs->connected) { |
51370e5b | 267 | gig_dbg(DEBUG_IF, "not connected"); |
ee8a4b7f HL |
268 | retval = -ENODEV; |
269 | } else { | |
475be4d8 | 270 | mc = (cs->control_state | set) & ~clear & (TIOCM_RTS | TIOCM_DTR); |
ee8a4b7f HL |
271 | retval = cs->ops->set_modem_ctrl(cs, cs->control_state, mc); |
272 | cs->control_state = mc; | |
273 | } | |
274 | ||
abfd1dc7 | 275 | mutex_unlock(&cs->mutex); |
ee8a4b7f HL |
276 | |
277 | return retval; | |
278 | } | |
279 | ||
280 | static int if_write(struct tty_struct *tty, const unsigned char *buf, int count) | |
281 | { | |
fc258f89 | 282 | struct cardstate *cs = tty->driver_data; |
e3628dd1 TS |
283 | struct cmdbuf_t *cb; |
284 | int retval; | |
ee8a4b7f | 285 | |
784d5858 | 286 | gig_dbg(DEBUG_IF, "%u: %s()", cs->minor_index, __func__); |
ee8a4b7f | 287 | |
abfd1dc7 | 288 | if (mutex_lock_interruptible(&cs->mutex)) |
d9ba9c91 | 289 | return -ERESTARTSYS; |
ee8a4b7f | 290 | |
51370e5b TS |
291 | if (!cs->connected) { |
292 | gig_dbg(DEBUG_IF, "not connected"); | |
293 | retval = -ENODEV; | |
e3628dd1 TS |
294 | goto done; |
295 | } | |
e3628dd1 | 296 | if (cs->mstate != MS_LOCKED) { |
5002779d | 297 | dev_warn(cs->dev, "can't write to unlocked device\n"); |
ee8a4b7f | 298 | retval = -EBUSY; |
e3628dd1 TS |
299 | goto done; |
300 | } | |
301 | if (count <= 0) { | |
302 | /* nothing to do */ | |
303 | retval = 0; | |
304 | goto done; | |
ee8a4b7f HL |
305 | } |
306 | ||
e3628dd1 TS |
307 | cb = kmalloc(sizeof(struct cmdbuf_t) + count, GFP_KERNEL); |
308 | if (!cb) { | |
309 | dev_err(cs->dev, "%s: out of memory\n", __func__); | |
310 | retval = -ENOMEM; | |
311 | goto done; | |
312 | } | |
ee8a4b7f | 313 | |
e3628dd1 TS |
314 | memcpy(cb->buf, buf, count); |
315 | cb->len = count; | |
316 | cb->offset = 0; | |
317 | cb->next = NULL; | |
318 | cb->wake_tasklet = &cs->if_wake_tasklet; | |
319 | retval = cs->ops->write_cmd(cs, cb); | |
320 | done: | |
321 | mutex_unlock(&cs->mutex); | |
ee8a4b7f HL |
322 | return retval; |
323 | } | |
324 | ||
325 | static int if_write_room(struct tty_struct *tty) | |
326 | { | |
fc258f89 | 327 | struct cardstate *cs = tty->driver_data; |
cdc48270 | 328 | int retval; |
ee8a4b7f | 329 | |
784d5858 | 330 | gig_dbg(DEBUG_IF, "%u: %s()", cs->minor_index, __func__); |
ee8a4b7f | 331 | |
abfd1dc7 | 332 | if (mutex_lock_interruptible(&cs->mutex)) |
d9ba9c91 | 333 | return -ERESTARTSYS; |
ee8a4b7f | 334 | |
51370e5b TS |
335 | if (!cs->connected) { |
336 | gig_dbg(DEBUG_IF, "not connected"); | |
337 | retval = -ENODEV; | |
fc258f89 | 338 | } else if (cs->mstate != MS_LOCKED) { |
5002779d | 339 | dev_warn(cs->dev, "can't write to unlocked device\n"); |
9d4bee2b | 340 | retval = -EBUSY; |
ee8a4b7f HL |
341 | } else |
342 | retval = cs->ops->write_room(cs); | |
343 | ||
abfd1dc7 | 344 | mutex_unlock(&cs->mutex); |
ee8a4b7f HL |
345 | |
346 | return retval; | |
347 | } | |
348 | ||
349 | static int if_chars_in_buffer(struct tty_struct *tty) | |
350 | { | |
fc258f89 | 351 | struct cardstate *cs = tty->driver_data; |
a4304f2d | 352 | int retval = 0; |
ee8a4b7f | 353 | |
784d5858 | 354 | gig_dbg(DEBUG_IF, "%u: %s()", cs->minor_index, __func__); |
ee8a4b7f | 355 | |
a4304f2d | 356 | mutex_lock(&cs->mutex); |
ee8a4b7f | 357 | |
a4304f2d | 358 | if (!cs->connected) |
51370e5b | 359 | gig_dbg(DEBUG_IF, "not connected"); |
a4304f2d | 360 | else if (cs->mstate != MS_LOCKED) |
5002779d | 361 | dev_warn(cs->dev, "can't write to unlocked device\n"); |
a4304f2d | 362 | else |
ee8a4b7f HL |
363 | retval = cs->ops->chars_in_buffer(cs); |
364 | ||
abfd1dc7 | 365 | mutex_unlock(&cs->mutex); |
ee8a4b7f HL |
366 | |
367 | return retval; | |
368 | } | |
369 | ||
370 | static void if_throttle(struct tty_struct *tty) | |
371 | { | |
fc258f89 | 372 | struct cardstate *cs = tty->driver_data; |
ee8a4b7f | 373 | |
784d5858 | 374 | gig_dbg(DEBUG_IF, "%u: %s()", cs->minor_index, __func__); |
ee8a4b7f | 375 | |
abfd1dc7 | 376 | mutex_lock(&cs->mutex); |
ee8a4b7f | 377 | |
51370e5b TS |
378 | if (!cs->connected) |
379 | gig_dbg(DEBUG_IF, "not connected"); /* nothing to do */ | |
d9ba9c91 | 380 | else |
1528b18f | 381 | gig_dbg(DEBUG_IF, "%s: not implemented\n", __func__); |
ee8a4b7f | 382 | |
abfd1dc7 | 383 | mutex_unlock(&cs->mutex); |
ee8a4b7f HL |
384 | } |
385 | ||
386 | static void if_unthrottle(struct tty_struct *tty) | |
387 | { | |
fc258f89 | 388 | struct cardstate *cs = tty->driver_data; |
ee8a4b7f | 389 | |
784d5858 | 390 | gig_dbg(DEBUG_IF, "%u: %s()", cs->minor_index, __func__); |
ee8a4b7f | 391 | |
abfd1dc7 | 392 | mutex_lock(&cs->mutex); |
ee8a4b7f | 393 | |
51370e5b TS |
394 | if (!cs->connected) |
395 | gig_dbg(DEBUG_IF, "not connected"); /* nothing to do */ | |
d9ba9c91 | 396 | else |
1528b18f | 397 | gig_dbg(DEBUG_IF, "%s: not implemented\n", __func__); |
ee8a4b7f | 398 | |
abfd1dc7 | 399 | mutex_unlock(&cs->mutex); |
ee8a4b7f HL |
400 | } |
401 | ||
606d099c | 402 | static void if_set_termios(struct tty_struct *tty, struct ktermios *old) |
ee8a4b7f | 403 | { |
fc258f89 | 404 | struct cardstate *cs = tty->driver_data; |
ee8a4b7f HL |
405 | unsigned int iflag; |
406 | unsigned int cflag; | |
407 | unsigned int old_cflag; | |
408 | unsigned int control_state, new_state; | |
409 | ||
784d5858 | 410 | gig_dbg(DEBUG_IF, "%u: %s()", cs->minor_index, __func__); |
ee8a4b7f | 411 | |
abfd1dc7 | 412 | mutex_lock(&cs->mutex); |
ee8a4b7f | 413 | |
51370e5b TS |
414 | if (!cs->connected) { |
415 | gig_dbg(DEBUG_IF, "not connected"); | |
ee8a4b7f HL |
416 | goto out; |
417 | } | |
418 | ||
adc8d746 AC |
419 | iflag = tty->termios.c_iflag; |
420 | cflag = tty->termios.c_cflag; | |
d9ba9c91 | 421 | old_cflag = old ? old->c_cflag : cflag; |
784d5858 TS |
422 | gig_dbg(DEBUG_IF, "%u: iflag %x cflag %x old %x", |
423 | cs->minor_index, iflag, cflag, old_cflag); | |
ee8a4b7f HL |
424 | |
425 | /* get a local copy of the current port settings */ | |
426 | control_state = cs->control_state; | |
427 | ||
428 | /* | |
429 | * Update baud rate. | |
430 | * Do not attempt to cache old rates and skip settings, | |
431 | * disconnects screw such tricks up completely. | |
432 | * Premature optimization is the root of all evil. | |
433 | */ | |
434 | ||
784d5858 | 435 | /* reassert DTR and (maybe) RTS on transition from B0 */ |
ee8a4b7f HL |
436 | if ((old_cflag & CBAUD) == B0) { |
437 | new_state = control_state | TIOCM_DTR; | |
438 | /* don't set RTS if using hardware flow control */ | |
439 | if (!(old_cflag & CRTSCTS)) | |
440 | new_state |= TIOCM_RTS; | |
784d5858 TS |
441 | gig_dbg(DEBUG_IF, "%u: from B0 - set DTR%s", |
442 | cs->minor_index, | |
443 | (new_state & TIOCM_RTS) ? " only" : "/RTS"); | |
ee8a4b7f HL |
444 | cs->ops->set_modem_ctrl(cs, control_state, new_state); |
445 | control_state = new_state; | |
446 | } | |
447 | ||
448 | cs->ops->baud_rate(cs, cflag & CBAUD); | |
449 | ||
450 | if ((cflag & CBAUD) == B0) { | |
451 | /* Drop RTS and DTR */ | |
784d5858 | 452 | gig_dbg(DEBUG_IF, "%u: to B0 - drop DTR/RTS", cs->minor_index); |
ee8a4b7f HL |
453 | new_state = control_state & ~(TIOCM_DTR | TIOCM_RTS); |
454 | cs->ops->set_modem_ctrl(cs, control_state, new_state); | |
455 | control_state = new_state; | |
456 | } | |
457 | ||
458 | /* | |
459 | * Update line control register (LCR) | |
460 | */ | |
461 | ||
462 | cs->ops->set_line_ctrl(cs, cflag); | |
463 | ||
ee8a4b7f HL |
464 | /* save off the modified port settings */ |
465 | cs->control_state = control_state; | |
466 | ||
467 | out: | |
abfd1dc7 | 468 | mutex_unlock(&cs->mutex); |
ee8a4b7f HL |
469 | } |
470 | ||
cdc48270 TS |
471 | static const struct tty_operations if_ops = { |
472 | .open = if_open, | |
473 | .close = if_close, | |
474 | .ioctl = if_ioctl, | |
475 | .write = if_write, | |
476 | .write_room = if_write_room, | |
477 | .chars_in_buffer = if_chars_in_buffer, | |
478 | .set_termios = if_set_termios, | |
479 | .throttle = if_throttle, | |
480 | .unthrottle = if_unthrottle, | |
481 | .tiocmget = if_tiocmget, | |
482 | .tiocmset = if_tiocmset, | |
483 | }; | |
484 | ||
ee8a4b7f HL |
485 | |
486 | /* wakeup tasklet for the write operation */ | |
487 | static void if_wake(unsigned long data) | |
488 | { | |
48a7466f | 489 | struct cardstate *cs = (struct cardstate *)data; |
ee8a4b7f | 490 | |
6aad04f2 | 491 | tty_port_tty_wakeup(&cs->port); |
ee8a4b7f HL |
492 | } |
493 | ||
494 | /*** interface to common ***/ | |
495 | ||
496 | void gigaset_if_init(struct cardstate *cs) | |
497 | { | |
498 | struct gigaset_driver *drv; | |
499 | ||
500 | drv = cs->driver; | |
501 | if (!drv->have_tty) | |
502 | return; | |
503 | ||
5452fee2 | 504 | tasklet_init(&cs->if_wake_tasklet, if_wake, (unsigned long) cs); |
7435f50e TS |
505 | |
506 | mutex_lock(&cs->mutex); | |
734cc178 JS |
507 | cs->tty_dev = tty_port_register_device(&cs->port, drv->tty, |
508 | cs->minor_index, NULL); | |
3dda4e37 | 509 | |
01107d34 GKH |
510 | if (!IS_ERR(cs->tty_dev)) |
511 | dev_set_drvdata(cs->tty_dev, cs); | |
3dda4e37 | 512 | else { |
42e3d611 | 513 | pr_warning("could not register device to the tty subsystem\n"); |
01107d34 | 514 | cs->tty_dev = NULL; |
3dda4e37 | 515 | } |
7435f50e | 516 | mutex_unlock(&cs->mutex); |
ee8a4b7f HL |
517 | } |
518 | ||
519 | void gigaset_if_free(struct cardstate *cs) | |
520 | { | |
521 | struct gigaset_driver *drv; | |
522 | ||
523 | drv = cs->driver; | |
524 | if (!drv->have_tty) | |
525 | return; | |
526 | ||
527 | tasklet_disable(&cs->if_wake_tasklet); | |
528 | tasklet_kill(&cs->if_wake_tasklet); | |
01107d34 | 529 | cs->tty_dev = NULL; |
ee8a4b7f HL |
530 | tty_unregister_device(drv->tty, cs->minor_index); |
531 | } | |
532 | ||
1cec9727 TS |
533 | /** |
534 | * gigaset_if_receive() - pass a received block of data to the tty device | |
535 | * @cs: device descriptor structure. | |
536 | * @buffer: received data. | |
537 | * @len: number of bytes received. | |
538 | * | |
539 | * Called by asyncdata/isocdata if a block of data received from the | |
540 | * device must be sent to userspace through the ttyG* device. | |
541 | */ | |
ee8a4b7f | 542 | void gigaset_if_receive(struct cardstate *cs, |
784d5858 | 543 | unsigned char *buffer, size_t len) |
ee8a4b7f | 544 | { |
05c7cd39 | 545 | tty_insert_flip_string(&cs->port, buffer, len); |
2e124b4a | 546 | tty_flip_buffer_push(&cs->port); |
ee8a4b7f HL |
547 | } |
548 | EXPORT_SYMBOL_GPL(gigaset_if_receive); | |
549 | ||
550 | /* gigaset_if_initdriver | |
551 | * Initialize tty interface. | |
552 | * parameters: | |
784d5858 TS |
553 | * drv Driver |
554 | * procname Name of the driver (e.g. for /proc/tty/drivers) | |
555 | * devname Name of the device files (prefix without minor number) | |
ee8a4b7f HL |
556 | */ |
557 | void gigaset_if_initdriver(struct gigaset_driver *drv, const char *procname, | |
f4eaa370 | 558 | const char *devname) |
ee8a4b7f | 559 | { |
ee8a4b7f HL |
560 | int ret; |
561 | struct tty_driver *tty; | |
562 | ||
563 | drv->have_tty = 0; | |
564 | ||
2f16669d | 565 | drv->tty = tty = alloc_tty_driver(drv->minors); |
d9ba9c91 | 566 | if (tty == NULL) |
ee8a4b7f | 567 | goto enomem; |
ee8a4b7f | 568 | |
5bd49735 JP |
569 | tty->type = TTY_DRIVER_TYPE_SERIAL; |
570 | tty->subtype = SERIAL_TYPE_NORMAL; | |
331b8319 | 571 | tty->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV; |
ee8a4b7f HL |
572 | |
573 | tty->driver_name = procname; | |
574 | tty->name = devname; | |
575 | tty->minor_start = drv->minor; | |
ee8a4b7f | 576 | |
d9ba9c91 TS |
577 | tty->init_termios = tty_std_termios; |
578 | tty->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL; | |
ee8a4b7f HL |
579 | tty_set_operations(tty, &if_ops); |
580 | ||
581 | ret = tty_register_driver(tty); | |
582 | if (ret < 0) { | |
c8770dca | 583 | pr_err("error %d registering tty driver\n", ret); |
ee8a4b7f HL |
584 | goto error; |
585 | } | |
784d5858 | 586 | gig_dbg(DEBUG_IF, "tty driver initialized"); |
ee8a4b7f HL |
587 | drv->have_tty = 1; |
588 | return; | |
589 | ||
590 | enomem: | |
c8770dca | 591 | pr_err("out of memory\n"); |
ee8a4b7f HL |
592 | error: |
593 | if (drv->tty) | |
594 | put_tty_driver(drv->tty); | |
595 | } | |
596 | ||
597 | void gigaset_if_freedriver(struct gigaset_driver *drv) | |
598 | { | |
599 | if (!drv->have_tty) | |
600 | return; | |
601 | ||
602 | drv->have_tty = 0; | |
603 | tty_unregister_driver(drv->tty); | |
604 | put_tty_driver(drv->tty); | |
605 | } |