Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /********************************************************************* |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 2 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3 | * Filename: ircomm_tty.c |
| 4 | * Version: 1.0 |
| 5 | * Description: IrCOMM serial TTY driver |
| 6 | * Status: Experimental. |
| 7 | * Author: Dag Brattli <dagb@cs.uit.no> |
| 8 | * Created at: Sun Jun 6 21:00:56 1999 |
| 9 | * Modified at: Wed Feb 23 00:09:02 2000 |
| 10 | * Modified by: Dag Brattli <dagb@cs.uit.no> |
| 11 | * Sources: serial.c and previous IrCOMM work by Takahide Higuchi |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 12 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 13 | * Copyright (c) 1999-2000 Dag Brattli, All Rights Reserved. |
| 14 | * Copyright (c) 2000-2003 Jean Tourrilhes <jt@hpl.hp.com> |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 15 | * |
| 16 | * This program is free software; you can redistribute it and/or |
| 17 | * modify it under the terms of the GNU General Public License as |
| 18 | * published by the Free Software Foundation; either version 2 of |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 19 | * the License, or (at your option) any later version. |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 20 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 21 | * This program is distributed in the hope that it will be useful, |
| 22 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 23 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 24 | * GNU General Public License for more details. |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 25 | * |
| 26 | * You should have received a copy of the GNU General Public License |
| 27 | * along with this program; if not, write to the Free Software |
| 28 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | * MA 02111-1307 USA |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 30 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 31 | ********************************************************************/ |
| 32 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 33 | #include <linux/init.h> |
| 34 | #include <linux/module.h> |
| 35 | #include <linux/fs.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 36 | #include <linux/slab.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 | #include <linux/sched.h> |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 38 | #include <linux/seq_file.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 | #include <linux/termios.h> |
| 40 | #include <linux/tty.h> |
Amit Virdi | cbfd152 | 2011-05-12 01:04:40 +0000 | [diff] [blame] | 41 | #include <linux/tty_flip.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 42 | #include <linux/interrupt.h> |
| 43 | #include <linux/device.h> /* for MODULE_ALIAS_CHARDEV_MAJOR */ |
| 44 | |
| 45 | #include <asm/uaccess.h> |
| 46 | |
| 47 | #include <net/irda/irda.h> |
| 48 | #include <net/irda/irmod.h> |
| 49 | |
| 50 | #include <net/irda/ircomm_core.h> |
| 51 | #include <net/irda/ircomm_param.h> |
| 52 | #include <net/irda/ircomm_tty_attach.h> |
| 53 | #include <net/irda/ircomm_tty.h> |
| 54 | |
Jiri Slaby | 9c650ff | 2012-08-07 21:48:02 +0200 | [diff] [blame] | 55 | static int ircomm_tty_install(struct tty_driver *driver, |
| 56 | struct tty_struct *tty); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 57 | static int ircomm_tty_open(struct tty_struct *tty, struct file *filp); |
| 58 | static void ircomm_tty_close(struct tty_struct * tty, struct file *filp); |
| 59 | static int ircomm_tty_write(struct tty_struct * tty, |
| 60 | const unsigned char *buf, int count); |
| 61 | static int ircomm_tty_write_room(struct tty_struct *tty); |
| 62 | static void ircomm_tty_throttle(struct tty_struct *tty); |
| 63 | static void ircomm_tty_unthrottle(struct tty_struct *tty); |
| 64 | static int ircomm_tty_chars_in_buffer(struct tty_struct *tty); |
| 65 | static void ircomm_tty_flush_buffer(struct tty_struct *tty); |
| 66 | static void ircomm_tty_send_xchar(struct tty_struct *tty, char ch); |
| 67 | static void ircomm_tty_wait_until_sent(struct tty_struct *tty, int timeout); |
| 68 | static void ircomm_tty_hangup(struct tty_struct *tty); |
David Howells | c402895 | 2006-11-22 14:57:56 +0000 | [diff] [blame] | 69 | static void ircomm_tty_do_softint(struct work_struct *work); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 70 | static void ircomm_tty_shutdown(struct ircomm_tty_cb *self); |
| 71 | static void ircomm_tty_stop(struct tty_struct *tty); |
| 72 | |
| 73 | static int ircomm_tty_data_indication(void *instance, void *sap, |
| 74 | struct sk_buff *skb); |
| 75 | static int ircomm_tty_control_indication(void *instance, void *sap, |
| 76 | struct sk_buff *skb); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 77 | static void ircomm_tty_flow_indication(void *instance, void *sap, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 78 | LOCAL_FLOW cmd); |
| 79 | #ifdef CONFIG_PROC_FS |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 80 | static const struct file_operations ircomm_tty_proc_fops; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 81 | #endif /* CONFIG_PROC_FS */ |
| 82 | static struct tty_driver *driver; |
| 83 | |
Adrian Bunk | d76081f | 2007-10-26 03:56:43 -0700 | [diff] [blame] | 84 | static hashbin_t *ircomm_tty = NULL; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 85 | |
Jeff Dike | b68e31d | 2006-10-02 02:17:18 -0700 | [diff] [blame] | 86 | static const struct tty_operations ops = { |
Jiri Slaby | 9c650ff | 2012-08-07 21:48:02 +0200 | [diff] [blame] | 87 | .install = ircomm_tty_install, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 88 | .open = ircomm_tty_open, |
| 89 | .close = ircomm_tty_close, |
| 90 | .write = ircomm_tty_write, |
| 91 | .write_room = ircomm_tty_write_room, |
| 92 | .chars_in_buffer = ircomm_tty_chars_in_buffer, |
| 93 | .flush_buffer = ircomm_tty_flush_buffer, |
| 94 | .ioctl = ircomm_tty_ioctl, /* ircomm_tty_ioctl.c */ |
| 95 | .tiocmget = ircomm_tty_tiocmget, /* ircomm_tty_ioctl.c */ |
| 96 | .tiocmset = ircomm_tty_tiocmset, /* ircomm_tty_ioctl.c */ |
| 97 | .throttle = ircomm_tty_throttle, |
| 98 | .unthrottle = ircomm_tty_unthrottle, |
| 99 | .send_xchar = ircomm_tty_send_xchar, |
| 100 | .set_termios = ircomm_tty_set_termios, |
| 101 | .stop = ircomm_tty_stop, |
| 102 | .start = ircomm_tty_start, |
| 103 | .hangup = ircomm_tty_hangup, |
| 104 | .wait_until_sent = ircomm_tty_wait_until_sent, |
| 105 | #ifdef CONFIG_PROC_FS |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 106 | .proc_fops = &ircomm_tty_proc_fops, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 107 | #endif /* CONFIG_PROC_FS */ |
| 108 | }; |
| 109 | |
Jiri Slaby | 0ba9ff8 | 2012-06-04 13:35:23 +0200 | [diff] [blame] | 110 | static void ircomm_port_raise_dtr_rts(struct tty_port *port, int raise) |
| 111 | { |
| 112 | struct ircomm_tty_cb *self = container_of(port, struct ircomm_tty_cb, |
| 113 | port); |
| 114 | /* |
| 115 | * Here, we use to lock those two guys, but as ircomm_param_request() |
| 116 | * does it itself, I don't see the point (and I see the deadlock). |
| 117 | * Jean II |
| 118 | */ |
| 119 | if (raise) |
| 120 | self->settings.dte |= IRCOMM_RTS | IRCOMM_DTR; |
| 121 | else |
| 122 | self->settings.dte &= ~(IRCOMM_RTS | IRCOMM_DTR); |
| 123 | |
| 124 | ircomm_param_request(self, IRCOMM_DTE, TRUE); |
| 125 | } |
| 126 | |
| 127 | static int ircomm_port_carrier_raised(struct tty_port *port) |
| 128 | { |
| 129 | struct ircomm_tty_cb *self = container_of(port, struct ircomm_tty_cb, |
| 130 | port); |
| 131 | return self->settings.dce & IRCOMM_CD; |
| 132 | } |
| 133 | |
| 134 | static const struct tty_port_operations ircomm_port_ops = { |
| 135 | .dtr_rts = ircomm_port_raise_dtr_rts, |
| 136 | .carrier_raised = ircomm_port_carrier_raised, |
| 137 | }; |
| 138 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 139 | /* |
| 140 | * Function ircomm_tty_init() |
| 141 | * |
| 142 | * Init IrCOMM TTY layer/driver |
| 143 | * |
| 144 | */ |
| 145 | static int __init ircomm_tty_init(void) |
| 146 | { |
| 147 | driver = alloc_tty_driver(IRCOMM_TTY_PORTS); |
| 148 | if (!driver) |
| 149 | return -ENOMEM; |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 150 | ircomm_tty = hashbin_new(HB_LOCK); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 151 | if (ircomm_tty == NULL) { |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 152 | IRDA_ERROR("%s(), can't allocate hashbin!\n", __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 153 | put_tty_driver(driver); |
| 154 | return -ENOMEM; |
| 155 | } |
| 156 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 157 | driver->driver_name = "ircomm"; |
| 158 | driver->name = "ircomm"; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 159 | driver->major = IRCOMM_TTY_MAJOR; |
| 160 | driver->minor_start = IRCOMM_TTY_MINOR; |
| 161 | driver->type = TTY_DRIVER_TYPE_SERIAL; |
| 162 | driver->subtype = SERIAL_TYPE_NORMAL; |
| 163 | driver->init_termios = tty_std_termios; |
| 164 | driver->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL; |
| 165 | driver->flags = TTY_DRIVER_REAL_RAW; |
| 166 | tty_set_operations(driver, &ops); |
| 167 | if (tty_register_driver(driver)) { |
| 168 | IRDA_ERROR("%s(): Couldn't register serial driver\n", |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 169 | __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 170 | put_tty_driver(driver); |
| 171 | return -1; |
| 172 | } |
| 173 | return 0; |
| 174 | } |
| 175 | |
| 176 | static void __exit __ircomm_tty_cleanup(struct ircomm_tty_cb *self) |
| 177 | { |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 178 | IRDA_DEBUG(0, "%s()\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 179 | |
| 180 | IRDA_ASSERT(self != NULL, return;); |
| 181 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;); |
| 182 | |
| 183 | ircomm_tty_shutdown(self); |
| 184 | |
| 185 | self->magic = 0; |
Jiri Slaby | 191c5f1 | 2012-11-15 09:49:56 +0100 | [diff] [blame] | 186 | tty_port_destroy(&self->port); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 187 | kfree(self); |
| 188 | } |
| 189 | |
| 190 | /* |
| 191 | * Function ircomm_tty_cleanup () |
| 192 | * |
| 193 | * Remove IrCOMM TTY layer/driver |
| 194 | * |
| 195 | */ |
| 196 | static void __exit ircomm_tty_cleanup(void) |
| 197 | { |
| 198 | int ret; |
| 199 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 200 | IRDA_DEBUG(4, "%s()\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 201 | |
| 202 | ret = tty_unregister_driver(driver); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 203 | if (ret) { |
| 204 | IRDA_ERROR("%s(), failed to unregister driver\n", |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 205 | __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 206 | return; |
| 207 | } |
| 208 | |
| 209 | hashbin_delete(ircomm_tty, (FREE_FUNC) __ircomm_tty_cleanup); |
| 210 | put_tty_driver(driver); |
| 211 | } |
| 212 | |
| 213 | /* |
| 214 | * Function ircomm_startup (self) |
| 215 | * |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 216 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 217 | * |
| 218 | */ |
| 219 | static int ircomm_tty_startup(struct ircomm_tty_cb *self) |
| 220 | { |
| 221 | notify_t notify; |
| 222 | int ret = -ENODEV; |
| 223 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 224 | IRDA_DEBUG(2, "%s()\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 225 | |
| 226 | IRDA_ASSERT(self != NULL, return -1;); |
| 227 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;); |
| 228 | |
| 229 | /* Check if already open */ |
Jiri Slaby | 849d5a9 | 2012-06-04 13:35:19 +0200 | [diff] [blame] | 230 | if (test_and_set_bit(ASYNCB_INITIALIZED, &self->port.flags)) { |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 231 | IRDA_DEBUG(2, "%s(), already open so break out!\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 232 | return 0; |
| 233 | } |
| 234 | |
| 235 | /* Register with IrCOMM */ |
| 236 | irda_notify_init(¬ify); |
| 237 | /* These callbacks we must handle ourselves */ |
| 238 | notify.data_indication = ircomm_tty_data_indication; |
| 239 | notify.udata_indication = ircomm_tty_control_indication; |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 240 | notify.flow_indication = ircomm_tty_flow_indication; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 241 | |
| 242 | /* Use the ircomm_tty interface for these ones */ |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 243 | notify.disconnect_indication = ircomm_tty_disconnect_indication; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 244 | notify.connect_confirm = ircomm_tty_connect_confirm; |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 245 | notify.connect_indication = ircomm_tty_connect_indication; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 246 | strlcpy(notify.name, "ircomm_tty", sizeof(notify.name)); |
| 247 | notify.instance = self; |
| 248 | |
| 249 | if (!self->ircomm) { |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 250 | self->ircomm = ircomm_open(¬ify, self->service_type, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 251 | self->line); |
| 252 | } |
| 253 | if (!self->ircomm) |
| 254 | goto err; |
| 255 | |
| 256 | self->slsap_sel = self->ircomm->slsap_sel; |
| 257 | |
| 258 | /* Connect IrCOMM link with remote device */ |
| 259 | ret = ircomm_tty_attach_cable(self); |
| 260 | if (ret < 0) { |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 261 | IRDA_ERROR("%s(), error attaching cable!\n", __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 262 | goto err; |
| 263 | } |
| 264 | |
| 265 | return 0; |
| 266 | err: |
Jiri Slaby | 849d5a9 | 2012-06-04 13:35:19 +0200 | [diff] [blame] | 267 | clear_bit(ASYNCB_INITIALIZED, &self->port.flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 268 | return ret; |
| 269 | } |
| 270 | |
| 271 | /* |
| 272 | * Function ircomm_block_til_ready (self, filp) |
| 273 | * |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 274 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 275 | * |
| 276 | */ |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 277 | static int ircomm_tty_block_til_ready(struct ircomm_tty_cb *self, |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 278 | struct tty_struct *tty, struct file *filp) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 279 | { |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 280 | struct tty_port *port = &self->port; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 281 | DECLARE_WAITQUEUE(wait, current); |
| 282 | int retval; |
| 283 | int do_clocal = 0, extra_count = 0; |
| 284 | unsigned long flags; |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 285 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 286 | IRDA_DEBUG(2, "%s()\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 287 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 288 | /* |
| 289 | * If non-blocking mode is set, or the port is not enabled, |
| 290 | * then make the check up front and then exit. |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 291 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 292 | if (filp->f_flags & O_NONBLOCK || tty->flags & (1 << TTY_IO_ERROR)){ |
| 293 | /* nonblock mode is set or port is not enabled */ |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 294 | port->flags |= ASYNC_NORMAL_ACTIVE; |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 295 | IRDA_DEBUG(1, "%s(), O_NONBLOCK requested!\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 296 | return 0; |
| 297 | } |
| 298 | |
Alan Cox | adc8d74 | 2012-07-14 15:31:47 +0100 | [diff] [blame] | 299 | if (tty->termios.c_cflag & CLOCAL) { |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 300 | IRDA_DEBUG(1, "%s(), doing CLOCAL!\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 301 | do_clocal = 1; |
| 302 | } |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 303 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 304 | /* Wait for carrier detect and the line to become |
| 305 | * free (i.e., not in use by the callout). While we are in |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 306 | * this loop, port->count is dropped by one, so that |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 307 | * mgsl_close() knows when to free things. We restore it upon |
| 308 | * exit, either normal or abnormal. |
| 309 | */ |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 310 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 311 | retval = 0; |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 312 | add_wait_queue(&port->open_wait, &wait); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 313 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 314 | IRDA_DEBUG(2, "%s(%d):block_til_ready before block on %s open_count=%d\n", |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 315 | __FILE__, __LINE__, tty->driver->name, port->count); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 316 | |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 317 | spin_lock_irqsave(&port->lock, flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 318 | if (!tty_hung_up_p(filp)) { |
| 319 | extra_count = 1; |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 320 | port->count--; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 321 | } |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 322 | spin_unlock_irqrestore(&port->lock, flags); |
| 323 | port->blocked_open++; |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 324 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 325 | while (1) { |
Alan Cox | adc8d74 | 2012-07-14 15:31:47 +0100 | [diff] [blame] | 326 | if (tty->termios.c_cflag & CBAUD) |
Jiri Slaby | 0ba9ff8 | 2012-06-04 13:35:23 +0200 | [diff] [blame] | 327 | tty_port_raise_dtr_rts(port); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 328 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 329 | current->state = TASK_INTERRUPTIBLE; |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 330 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 331 | if (tty_hung_up_p(filp) || |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 332 | !test_bit(ASYNCB_INITIALIZED, &port->flags)) { |
| 333 | retval = (port->flags & ASYNC_HUP_NOTIFY) ? |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 334 | -EAGAIN : -ERESTARTSYS; |
| 335 | break; |
| 336 | } |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 337 | |
| 338 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 339 | * Check if link is ready now. Even if CLOCAL is |
| 340 | * specified, we cannot return before the IrCOMM link is |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 341 | * ready |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 342 | */ |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 343 | if (!test_bit(ASYNCB_CLOSING, &port->flags) && |
Jiri Slaby | 0ba9ff8 | 2012-06-04 13:35:23 +0200 | [diff] [blame] | 344 | (do_clocal || tty_port_carrier_raised(port)) && |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 345 | self->state == IRCOMM_TTY_READY) |
| 346 | { |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 347 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 348 | } |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 349 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 350 | if (signal_pending(current)) { |
| 351 | retval = -ERESTARTSYS; |
| 352 | break; |
| 353 | } |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 354 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 355 | IRDA_DEBUG(1, "%s(%d):block_til_ready blocking on %s open_count=%d\n", |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 356 | __FILE__, __LINE__, tty->driver->name, port->count); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 357 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 358 | schedule(); |
| 359 | } |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 360 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 361 | __set_current_state(TASK_RUNNING); |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 362 | remove_wait_queue(&port->open_wait, &wait); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 363 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 364 | if (extra_count) { |
| 365 | /* ++ is not atomic, so this should be protected - Jean II */ |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 366 | spin_lock_irqsave(&port->lock, flags); |
| 367 | port->count++; |
| 368 | spin_unlock_irqrestore(&port->lock, flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 369 | } |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 370 | port->blocked_open--; |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 371 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 372 | IRDA_DEBUG(1, "%s(%d):block_til_ready after blocking on %s open_count=%d\n", |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 373 | __FILE__, __LINE__, tty->driver->name, port->count); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 374 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 375 | if (!retval) |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 376 | port->flags |= ASYNC_NORMAL_ACTIVE; |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 377 | |
| 378 | return retval; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 379 | } |
| 380 | |
Jiri Slaby | 9c650ff | 2012-08-07 21:48:02 +0200 | [diff] [blame] | 381 | |
| 382 | static int ircomm_tty_install(struct tty_driver *driver, struct tty_struct *tty) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 383 | { |
| 384 | struct ircomm_tty_cb *self; |
Jiri Slaby | 410235f | 2012-03-05 14:52:01 +0100 | [diff] [blame] | 385 | unsigned int line = tty->index; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 386 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 387 | /* Check if instance already exists */ |
| 388 | self = hashbin_lock_find(ircomm_tty, line, NULL); |
| 389 | if (!self) { |
| 390 | /* No, so make new instance */ |
Panagiotis Issaris | 0da974f | 2006-07-21 14:51:30 -0700 | [diff] [blame] | 391 | self = kzalloc(sizeof(struct ircomm_tty_cb), GFP_KERNEL); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 392 | if (self == NULL) { |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 393 | IRDA_ERROR("%s(), kmalloc failed!\n", __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 394 | return -ENOMEM; |
| 395 | } |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 396 | |
Jiri Slaby | a3cc9fc | 2012-06-04 13:35:16 +0200 | [diff] [blame] | 397 | tty_port_init(&self->port); |
Jiri Slaby | 0ba9ff8 | 2012-06-04 13:35:23 +0200 | [diff] [blame] | 398 | self->port.ops = &ircomm_port_ops; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 399 | self->magic = IRCOMM_TTY_MAGIC; |
| 400 | self->flow = FLOW_STOP; |
| 401 | |
| 402 | self->line = line; |
David Howells | c402895 | 2006-11-22 14:57:56 +0000 | [diff] [blame] | 403 | INIT_WORK(&self->tqueue, ircomm_tty_do_softint); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 404 | self->max_header_size = IRCOMM_TTY_HDR_UNINITIALISED; |
| 405 | self->max_data_size = IRCOMM_TTY_DATA_UNINITIALISED; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 406 | |
| 407 | /* Init some important stuff */ |
| 408 | init_timer(&self->watchdog_timer); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 409 | spin_lock_init(&self->spinlock); |
| 410 | |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 411 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 412 | * Force TTY into raw mode by default which is usually what |
| 413 | * we want for IrCOMM and IrLPT. This way applications will |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 414 | * not have to twiddle with printcap etc. |
Alan Cox | ad36b88 | 2009-01-02 13:50:20 +0000 | [diff] [blame] | 415 | * |
| 416 | * Note this is completely usafe and doesn't work properly |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 417 | */ |
Alan Cox | adc8d74 | 2012-07-14 15:31:47 +0100 | [diff] [blame] | 418 | tty->termios.c_iflag = 0; |
| 419 | tty->termios.c_oflag = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 420 | |
| 421 | /* Insert into hash */ |
| 422 | hashbin_insert(ircomm_tty, (irda_queue_t *) self, line, NULL); |
| 423 | } |
Jiri Slaby | 9c650ff | 2012-08-07 21:48:02 +0200 | [diff] [blame] | 424 | |
Sasha Levin | 6f56012 | 2012-10-04 20:01:21 -0400 | [diff] [blame] | 425 | tty->driver_data = self; |
| 426 | |
Jiri Slaby | 9c650ff | 2012-08-07 21:48:02 +0200 | [diff] [blame] | 427 | return tty_port_install(&self->port, driver, tty); |
| 428 | } |
| 429 | |
| 430 | /* |
| 431 | * Function ircomm_tty_open (tty, filp) |
| 432 | * |
| 433 | * This routine is called when a particular tty device is opened. This |
| 434 | * routine is mandatory; if this routine is not filled in, the attempted |
| 435 | * open will fail with ENODEV. |
| 436 | */ |
| 437 | static int ircomm_tty_open(struct tty_struct *tty, struct file *filp) |
| 438 | { |
| 439 | struct ircomm_tty_cb *self = tty->driver_data; |
| 440 | unsigned long flags; |
| 441 | int ret; |
| 442 | |
| 443 | IRDA_DEBUG(2, "%s()\n", __func__ ); |
| 444 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 445 | /* ++ is not atomic, so this should be protected - Jean II */ |
Jiri Slaby | e673927 | 2012-06-04 13:35:20 +0200 | [diff] [blame] | 446 | spin_lock_irqsave(&self->port.lock, flags); |
Jiri Slaby | 580d27b | 2012-06-04 13:35:18 +0200 | [diff] [blame] | 447 | self->port.count++; |
Jiri Slaby | e673927 | 2012-06-04 13:35:20 +0200 | [diff] [blame] | 448 | spin_unlock_irqrestore(&self->port.lock, flags); |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 449 | tty_port_tty_set(&self->port, tty); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 450 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 451 | IRDA_DEBUG(1, "%s(), %s%d, count = %d\n", __func__ , tty->driver->name, |
Jiri Slaby | 580d27b | 2012-06-04 13:35:18 +0200 | [diff] [blame] | 452 | self->line, self->port.count); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 453 | |
| 454 | /* Not really used by us, but lets do it anyway */ |
Jiri Slaby | d6c53c0 | 2013-01-03 15:53:05 +0100 | [diff] [blame] | 455 | self->port.low_latency = (self->port.flags & ASYNC_LOW_LATENCY) ? 1 : 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 456 | |
| 457 | /* |
| 458 | * If the port is the middle of closing, bail out now |
| 459 | */ |
| 460 | if (tty_hung_up_p(filp) || |
Jiri Slaby | 849d5a9 | 2012-06-04 13:35:19 +0200 | [diff] [blame] | 461 | test_bit(ASYNCB_CLOSING, &self->port.flags)) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 462 | |
| 463 | /* Hm, why are we blocking on ASYNC_CLOSING if we |
| 464 | * do return -EAGAIN/-ERESTARTSYS below anyway? |
| 465 | * IMHO it's either not needed in the first place |
| 466 | * or for some reason we need to make sure the async |
| 467 | * closing has been finished - if so, wouldn't we |
| 468 | * probably better sleep uninterruptible? |
| 469 | */ |
| 470 | |
Jiri Slaby | a3cc9fc | 2012-06-04 13:35:16 +0200 | [diff] [blame] | 471 | if (wait_event_interruptible(self->port.close_wait, |
Jiri Slaby | 849d5a9 | 2012-06-04 13:35:19 +0200 | [diff] [blame] | 472 | !test_bit(ASYNCB_CLOSING, &self->port.flags))) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 473 | IRDA_WARNING("%s - got signal while blocking on ASYNC_CLOSING!\n", |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 474 | __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 475 | return -ERESTARTSYS; |
| 476 | } |
| 477 | |
| 478 | #ifdef SERIAL_DO_RESTART |
Jiri Slaby | 849d5a9 | 2012-06-04 13:35:19 +0200 | [diff] [blame] | 479 | return (self->port.flags & ASYNC_HUP_NOTIFY) ? |
Eric Dumazet | a02cec2 | 2010-09-22 20:43:57 +0000 | [diff] [blame] | 480 | -EAGAIN : -ERESTARTSYS; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 481 | #else |
| 482 | return -EAGAIN; |
| 483 | #endif |
| 484 | } |
| 485 | |
| 486 | /* Check if this is a "normal" ircomm device, or an irlpt device */ |
Jiri Slaby | 9c650ff | 2012-08-07 21:48:02 +0200 | [diff] [blame] | 487 | if (self->line < 0x10) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 488 | self->service_type = IRCOMM_3_WIRE | IRCOMM_9_WIRE; |
| 489 | self->settings.service_type = IRCOMM_9_WIRE; /* 9 wire as default */ |
| 490 | /* Jan Kiszka -> add DSR/RI -> Conform to IrCOMM spec */ |
| 491 | self->settings.dce = IRCOMM_CTS | IRCOMM_CD | IRCOMM_DSR | IRCOMM_RI; /* Default line settings */ |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 492 | IRDA_DEBUG(2, "%s(), IrCOMM device\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 493 | } else { |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 494 | IRDA_DEBUG(2, "%s(), IrLPT device\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 495 | self->service_type = IRCOMM_3_WIRE_RAW; |
| 496 | self->settings.service_type = IRCOMM_3_WIRE_RAW; /* Default */ |
| 497 | } |
| 498 | |
| 499 | ret = ircomm_tty_startup(self); |
| 500 | if (ret) |
| 501 | return ret; |
| 502 | |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 503 | ret = ircomm_tty_block_til_ready(self, tty, filp); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 504 | if (ret) { |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 505 | IRDA_DEBUG(2, |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 506 | "%s(), returning after block_til_ready with %d\n", __func__ , |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 507 | ret); |
| 508 | |
| 509 | return ret; |
| 510 | } |
| 511 | return 0; |
| 512 | } |
| 513 | |
| 514 | /* |
| 515 | * Function ircomm_tty_close (tty, filp) |
| 516 | * |
| 517 | * This routine is called when a particular tty device is closed. |
| 518 | * |
| 519 | */ |
| 520 | static void ircomm_tty_close(struct tty_struct *tty, struct file *filp) |
| 521 | { |
| 522 | struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data; |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 523 | struct tty_port *port = &self->port; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 524 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 525 | IRDA_DEBUG(0, "%s()\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 526 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 527 | IRDA_ASSERT(self != NULL, return;); |
| 528 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;); |
| 529 | |
Jiri Slaby | c0e7865 | 2012-06-04 13:35:25 +0200 | [diff] [blame] | 530 | if (tty_port_close_start(port, tty, filp) == 0) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 531 | return; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 532 | |
| 533 | ircomm_tty_shutdown(self); |
| 534 | |
Alan Cox | f34d7a5 | 2008-04-30 00:54:13 -0700 | [diff] [blame] | 535 | tty_driver_flush_buffer(tty); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 536 | |
Jiri Slaby | a1e8440 | 2012-06-04 13:35:24 +0200 | [diff] [blame] | 537 | tty_port_close_end(port, tty); |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 538 | tty_port_tty_set(port, NULL); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 539 | } |
| 540 | |
| 541 | /* |
| 542 | * Function ircomm_tty_flush_buffer (tty) |
| 543 | * |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 544 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 545 | * |
| 546 | */ |
| 547 | static void ircomm_tty_flush_buffer(struct tty_struct *tty) |
| 548 | { |
| 549 | struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data; |
| 550 | |
| 551 | IRDA_ASSERT(self != NULL, return;); |
| 552 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;); |
| 553 | |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 554 | /* |
| 555 | * Let do_softint() do this to avoid race condition with |
| 556 | * do_softint() ;-) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 557 | */ |
| 558 | schedule_work(&self->tqueue); |
| 559 | } |
| 560 | |
| 561 | /* |
David Howells | c402895 | 2006-11-22 14:57:56 +0000 | [diff] [blame] | 562 | * Function ircomm_tty_do_softint (work) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 563 | * |
| 564 | * We use this routine to give the write wakeup to the user at at a |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 565 | * safe time (as fast as possible after write have completed). This |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 566 | * can be compared to the Tx interrupt. |
| 567 | */ |
David Howells | c402895 | 2006-11-22 14:57:56 +0000 | [diff] [blame] | 568 | static void ircomm_tty_do_softint(struct work_struct *work) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 569 | { |
David Howells | c402895 | 2006-11-22 14:57:56 +0000 | [diff] [blame] | 570 | struct ircomm_tty_cb *self = |
| 571 | container_of(work, struct ircomm_tty_cb, tqueue); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 572 | struct tty_struct *tty; |
| 573 | unsigned long flags; |
| 574 | struct sk_buff *skb, *ctrl_skb; |
| 575 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 576 | IRDA_DEBUG(2, "%s()\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 577 | |
| 578 | if (!self || self->magic != IRCOMM_TTY_MAGIC) |
| 579 | return; |
| 580 | |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 581 | tty = tty_port_tty_get(&self->port); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 582 | if (!tty) |
| 583 | return; |
| 584 | |
| 585 | /* Unlink control buffer */ |
| 586 | spin_lock_irqsave(&self->spinlock, flags); |
| 587 | |
| 588 | ctrl_skb = self->ctrl_skb; |
| 589 | self->ctrl_skb = NULL; |
| 590 | |
| 591 | spin_unlock_irqrestore(&self->spinlock, flags); |
| 592 | |
| 593 | /* Flush control buffer if any */ |
| 594 | if(ctrl_skb) { |
| 595 | if(self->flow == FLOW_START) |
| 596 | ircomm_control_request(self->ircomm, ctrl_skb); |
| 597 | /* Drop reference count - see ircomm_ttp_data_request(). */ |
| 598 | dev_kfree_skb(ctrl_skb); |
| 599 | } |
| 600 | |
| 601 | if (tty->hw_stopped) |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 602 | goto put; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 603 | |
| 604 | /* Unlink transmit buffer */ |
| 605 | spin_lock_irqsave(&self->spinlock, flags); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 606 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 607 | skb = self->tx_skb; |
| 608 | self->tx_skb = NULL; |
| 609 | |
| 610 | spin_unlock_irqrestore(&self->spinlock, flags); |
| 611 | |
| 612 | /* Flush transmit buffer if any */ |
| 613 | if (skb) { |
| 614 | ircomm_tty_do_event(self, IRCOMM_TTY_DATA_REQUEST, skb, NULL); |
| 615 | /* Drop reference count - see ircomm_ttp_data_request(). */ |
| 616 | dev_kfree_skb(skb); |
| 617 | } |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 618 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 619 | /* Check if user (still) wants to be waken up */ |
Alan Cox | a352def | 2008-07-16 21:53:12 +0100 | [diff] [blame] | 620 | tty_wakeup(tty); |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 621 | put: |
| 622 | tty_kref_put(tty); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 623 | } |
| 624 | |
| 625 | /* |
| 626 | * Function ircomm_tty_write (tty, buf, count) |
| 627 | * |
| 628 | * This routine is called by the kernel to write a series of characters |
| 629 | * to the tty device. The characters may come from user space or kernel |
| 630 | * space. This routine will return the number of characters actually |
| 631 | * accepted for writing. This routine is mandatory. |
| 632 | */ |
| 633 | static int ircomm_tty_write(struct tty_struct *tty, |
| 634 | const unsigned char *buf, int count) |
| 635 | { |
| 636 | struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data; |
| 637 | unsigned long flags; |
| 638 | struct sk_buff *skb; |
| 639 | int tailroom = 0; |
| 640 | int len = 0; |
| 641 | int size; |
| 642 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 643 | IRDA_DEBUG(2, "%s(), count=%d, hw_stopped=%d\n", __func__ , count, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 644 | tty->hw_stopped); |
| 645 | |
| 646 | IRDA_ASSERT(self != NULL, return -1;); |
| 647 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;); |
| 648 | |
| 649 | /* We may receive packets from the TTY even before we have finished |
| 650 | * our setup. Not cool. |
| 651 | * The problem is that we don't know the final header and data size |
| 652 | * to create the proper skb, so any skb we would create would have |
| 653 | * bogus header and data size, so need care. |
| 654 | * We use a bogus header size to safely detect this condition. |
| 655 | * Another problem is that hw_stopped was set to 0 way before it |
| 656 | * should be, so we would drop this skb. It should now be fixed. |
| 657 | * One option is to not accept data until we are properly setup. |
| 658 | * But, I suspect that when it happens, the ppp line discipline |
| 659 | * just "drops" the data, which might screw up connect scripts. |
| 660 | * The second option is to create a "safe skb", with large header |
| 661 | * and small size (see ircomm_tty_open() for values). |
| 662 | * We just need to make sure that when the real values get filled, |
| 663 | * we don't mess up the original "safe skb" (see tx_data_size). |
| 664 | * Jean II */ |
| 665 | if (self->max_header_size == IRCOMM_TTY_HDR_UNINITIALISED) { |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 666 | IRDA_DEBUG(1, "%s() : not initialised\n", __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 667 | #ifdef IRCOMM_NO_TX_BEFORE_INIT |
| 668 | /* We didn't consume anything, TTY will retry */ |
| 669 | return 0; |
| 670 | #endif |
| 671 | } |
| 672 | |
| 673 | if (count < 1) |
| 674 | return 0; |
| 675 | |
| 676 | /* Protect our manipulation of self->tx_skb and related */ |
| 677 | spin_lock_irqsave(&self->spinlock, flags); |
| 678 | |
| 679 | /* Fetch current transmit buffer */ |
| 680 | skb = self->tx_skb; |
| 681 | |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 682 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 683 | * Send out all the data we get, possibly as multiple fragmented |
| 684 | * frames, but this will only happen if the data is larger than the |
| 685 | * max data size. The normal case however is just the opposite, and |
| 686 | * this function may be called multiple times, and will then actually |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 687 | * defragment the data and send it out as one packet as soon as |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 688 | * possible, but at a safer point in time |
| 689 | */ |
| 690 | while (count) { |
| 691 | size = count; |
| 692 | |
| 693 | /* Adjust data size to the max data size */ |
| 694 | if (size > self->max_data_size) |
| 695 | size = self->max_data_size; |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 696 | |
| 697 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 698 | * Do we already have a buffer ready for transmit, or do |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 699 | * we need to allocate a new frame |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 700 | */ |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 701 | if (skb) { |
| 702 | /* |
| 703 | * Any room for more data at the end of the current |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 704 | * transmit buffer? Cannot use skb_tailroom, since |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 705 | * dev_alloc_skb gives us a larger skb than we |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 706 | * requested |
| 707 | * Note : use tx_data_size, because max_data_size |
| 708 | * may have changed and we don't want to overwrite |
| 709 | * the skb. - Jean II |
| 710 | */ |
| 711 | if ((tailroom = (self->tx_data_size - skb->len)) > 0) { |
| 712 | /* Adjust data to tailroom */ |
| 713 | if (size > tailroom) |
| 714 | size = tailroom; |
| 715 | } else { |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 716 | /* |
| 717 | * Current transmit frame is full, so break |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 718 | * out, so we can send it as soon as possible |
| 719 | */ |
| 720 | break; |
| 721 | } |
| 722 | } else { |
| 723 | /* Prepare a full sized frame */ |
Samuel Ortiz | 485fb2c | 2006-07-21 14:50:41 -0700 | [diff] [blame] | 724 | skb = alloc_skb(self->max_data_size+ |
| 725 | self->max_header_size, |
| 726 | GFP_ATOMIC); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 727 | if (!skb) { |
| 728 | spin_unlock_irqrestore(&self->spinlock, flags); |
| 729 | return -ENOBUFS; |
| 730 | } |
| 731 | skb_reserve(skb, self->max_header_size); |
| 732 | self->tx_skb = skb; |
| 733 | /* Remember skb size because max_data_size may |
| 734 | * change later on - Jean II */ |
| 735 | self->tx_data_size = self->max_data_size; |
| 736 | } |
| 737 | |
| 738 | /* Copy data */ |
| 739 | memcpy(skb_put(skb,size), buf + len, size); |
| 740 | |
| 741 | count -= size; |
| 742 | len += size; |
| 743 | } |
| 744 | |
| 745 | spin_unlock_irqrestore(&self->spinlock, flags); |
| 746 | |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 747 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 748 | * Schedule a new thread which will transmit the frame as soon |
| 749 | * as possible, but at a safe point in time. We do this so the |
| 750 | * "user" can give us data multiple times, as PPP does (because of |
| 751 | * its 256 byte tx buffer). We will then defragment and send out |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 752 | * all this data as one single packet. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 753 | */ |
| 754 | schedule_work(&self->tqueue); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 755 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 756 | return len; |
| 757 | } |
| 758 | |
| 759 | /* |
| 760 | * Function ircomm_tty_write_room (tty) |
| 761 | * |
| 762 | * This routine returns the numbers of characters the tty driver will |
| 763 | * accept for queuing to be written. This number is subject to change as |
| 764 | * output buffers get emptied, or if the output flow control is acted. |
| 765 | */ |
| 766 | static int ircomm_tty_write_room(struct tty_struct *tty) |
| 767 | { |
| 768 | struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data; |
| 769 | unsigned long flags; |
| 770 | int ret; |
| 771 | |
| 772 | IRDA_ASSERT(self != NULL, return -1;); |
| 773 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;); |
| 774 | |
| 775 | #ifdef IRCOMM_NO_TX_BEFORE_INIT |
| 776 | /* max_header_size tells us if the channel is initialised or not. */ |
| 777 | if (self->max_header_size == IRCOMM_TTY_HDR_UNINITIALISED) |
| 778 | /* Don't bother us yet */ |
| 779 | return 0; |
| 780 | #endif |
| 781 | |
| 782 | /* Check if we are allowed to transmit any data. |
| 783 | * hw_stopped is the regular flow control. |
| 784 | * Jean II */ |
| 785 | if (tty->hw_stopped) |
| 786 | ret = 0; |
| 787 | else { |
| 788 | spin_lock_irqsave(&self->spinlock, flags); |
| 789 | if (self->tx_skb) |
| 790 | ret = self->tx_data_size - self->tx_skb->len; |
| 791 | else |
| 792 | ret = self->max_data_size; |
| 793 | spin_unlock_irqrestore(&self->spinlock, flags); |
| 794 | } |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 795 | IRDA_DEBUG(2, "%s(), ret=%d\n", __func__ , ret); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 796 | |
| 797 | return ret; |
| 798 | } |
| 799 | |
| 800 | /* |
| 801 | * Function ircomm_tty_wait_until_sent (tty, timeout) |
| 802 | * |
| 803 | * This routine waits until the device has written out all of the |
| 804 | * characters in its transmitter FIFO. |
| 805 | */ |
| 806 | static void ircomm_tty_wait_until_sent(struct tty_struct *tty, int timeout) |
| 807 | { |
| 808 | struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data; |
| 809 | unsigned long orig_jiffies, poll_time; |
| 810 | unsigned long flags; |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 811 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 812 | IRDA_DEBUG(2, "%s()\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 813 | |
| 814 | IRDA_ASSERT(self != NULL, return;); |
| 815 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;); |
| 816 | |
| 817 | orig_jiffies = jiffies; |
| 818 | |
| 819 | /* Set poll time to 200 ms */ |
| 820 | poll_time = IRDA_MIN(timeout, msecs_to_jiffies(200)); |
| 821 | |
| 822 | spin_lock_irqsave(&self->spinlock, flags); |
| 823 | while (self->tx_skb && self->tx_skb->len) { |
| 824 | spin_unlock_irqrestore(&self->spinlock, flags); |
Nishanth Aravamudan | 121caf5 | 2005-09-12 14:15:34 -0700 | [diff] [blame] | 825 | schedule_timeout_interruptible(poll_time); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 826 | spin_lock_irqsave(&self->spinlock, flags); |
| 827 | if (signal_pending(current)) |
| 828 | break; |
| 829 | if (timeout && time_after(jiffies, orig_jiffies + timeout)) |
| 830 | break; |
| 831 | } |
| 832 | spin_unlock_irqrestore(&self->spinlock, flags); |
| 833 | current->state = TASK_RUNNING; |
| 834 | } |
| 835 | |
| 836 | /* |
| 837 | * Function ircomm_tty_throttle (tty) |
| 838 | * |
| 839 | * This routine notifies the tty driver that input buffers for the line |
| 840 | * discipline are close to full, and it should somehow signal that no |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 841 | * more characters should be sent to the tty. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 842 | */ |
| 843 | static void ircomm_tty_throttle(struct tty_struct *tty) |
| 844 | { |
| 845 | struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data; |
| 846 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 847 | IRDA_DEBUG(2, "%s()\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 848 | |
| 849 | IRDA_ASSERT(self != NULL, return;); |
| 850 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;); |
| 851 | |
| 852 | /* Software flow control? */ |
| 853 | if (I_IXOFF(tty)) |
| 854 | ircomm_tty_send_xchar(tty, STOP_CHAR(tty)); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 855 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 856 | /* Hardware flow control? */ |
Alan Cox | adc8d74 | 2012-07-14 15:31:47 +0100 | [diff] [blame] | 857 | if (tty->termios.c_cflag & CRTSCTS) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 858 | self->settings.dte &= ~IRCOMM_RTS; |
| 859 | self->settings.dte |= IRCOMM_DELTA_RTS; |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 860 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 861 | ircomm_param_request(self, IRCOMM_DTE, TRUE); |
| 862 | } |
| 863 | |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 864 | ircomm_flow_request(self->ircomm, FLOW_STOP); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 865 | } |
| 866 | |
| 867 | /* |
| 868 | * Function ircomm_tty_unthrottle (tty) |
| 869 | * |
| 870 | * This routine notifies the tty drivers that it should signals that |
| 871 | * characters can now be sent to the tty without fear of overrunning the |
| 872 | * input buffers of the line disciplines. |
| 873 | */ |
| 874 | static void ircomm_tty_unthrottle(struct tty_struct *tty) |
| 875 | { |
| 876 | struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data; |
| 877 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 878 | IRDA_DEBUG(2, "%s()\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 879 | |
| 880 | IRDA_ASSERT(self != NULL, return;); |
| 881 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;); |
| 882 | |
| 883 | /* Using software flow control? */ |
| 884 | if (I_IXOFF(tty)) { |
| 885 | ircomm_tty_send_xchar(tty, START_CHAR(tty)); |
| 886 | } |
| 887 | |
| 888 | /* Using hardware flow control? */ |
Alan Cox | adc8d74 | 2012-07-14 15:31:47 +0100 | [diff] [blame] | 889 | if (tty->termios.c_cflag & CRTSCTS) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 890 | self->settings.dte |= (IRCOMM_RTS|IRCOMM_DELTA_RTS); |
| 891 | |
| 892 | ircomm_param_request(self, IRCOMM_DTE, TRUE); |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 893 | IRDA_DEBUG(1, "%s(), FLOW_START\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 894 | } |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 895 | ircomm_flow_request(self->ircomm, FLOW_START); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 896 | } |
| 897 | |
| 898 | /* |
| 899 | * Function ircomm_tty_chars_in_buffer (tty) |
| 900 | * |
| 901 | * Indicates if there are any data in the buffer |
| 902 | * |
| 903 | */ |
| 904 | static int ircomm_tty_chars_in_buffer(struct tty_struct *tty) |
| 905 | { |
| 906 | struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data; |
| 907 | unsigned long flags; |
| 908 | int len = 0; |
| 909 | |
| 910 | IRDA_ASSERT(self != NULL, return -1;); |
| 911 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;); |
| 912 | |
| 913 | spin_lock_irqsave(&self->spinlock, flags); |
| 914 | |
| 915 | if (self->tx_skb) |
| 916 | len = self->tx_skb->len; |
| 917 | |
| 918 | spin_unlock_irqrestore(&self->spinlock, flags); |
| 919 | |
| 920 | return len; |
| 921 | } |
| 922 | |
| 923 | static void ircomm_tty_shutdown(struct ircomm_tty_cb *self) |
| 924 | { |
| 925 | unsigned long flags; |
| 926 | |
| 927 | IRDA_ASSERT(self != NULL, return;); |
| 928 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;); |
| 929 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 930 | IRDA_DEBUG(0, "%s()\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 931 | |
Jiri Slaby | 849d5a9 | 2012-06-04 13:35:19 +0200 | [diff] [blame] | 932 | if (!test_and_clear_bit(ASYNCB_INITIALIZED, &self->port.flags)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 933 | return; |
| 934 | |
| 935 | ircomm_tty_detach_cable(self); |
| 936 | |
| 937 | spin_lock_irqsave(&self->spinlock, flags); |
| 938 | |
| 939 | del_timer(&self->watchdog_timer); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 940 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 941 | /* Free parameter buffer */ |
| 942 | if (self->ctrl_skb) { |
| 943 | dev_kfree_skb(self->ctrl_skb); |
| 944 | self->ctrl_skb = NULL; |
| 945 | } |
| 946 | |
| 947 | /* Free transmit buffer */ |
| 948 | if (self->tx_skb) { |
| 949 | dev_kfree_skb(self->tx_skb); |
| 950 | self->tx_skb = NULL; |
| 951 | } |
| 952 | |
| 953 | if (self->ircomm) { |
| 954 | ircomm_close(self->ircomm); |
| 955 | self->ircomm = NULL; |
| 956 | } |
| 957 | |
| 958 | spin_unlock_irqrestore(&self->spinlock, flags); |
| 959 | } |
| 960 | |
| 961 | /* |
| 962 | * Function ircomm_tty_hangup (tty) |
| 963 | * |
| 964 | * This routine notifies the tty driver that it should hangup the tty |
| 965 | * device. |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 966 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 967 | */ |
| 968 | static void ircomm_tty_hangup(struct tty_struct *tty) |
| 969 | { |
| 970 | struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data; |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 971 | struct tty_port *port = &self->port; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 972 | unsigned long flags; |
| 973 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 974 | IRDA_DEBUG(0, "%s()\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 975 | |
| 976 | IRDA_ASSERT(self != NULL, return;); |
| 977 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;); |
| 978 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 979 | /* ircomm_tty_flush_buffer(tty); */ |
| 980 | ircomm_tty_shutdown(self); |
| 981 | |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 982 | spin_lock_irqsave(&port->lock, flags); |
| 983 | port->flags &= ~ASYNC_NORMAL_ACTIVE; |
| 984 | if (port->tty) { |
| 985 | set_bit(TTY_IO_ERROR, &port->tty->flags); |
| 986 | tty_kref_put(port->tty); |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 987 | } |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 988 | port->tty = NULL; |
| 989 | port->count = 0; |
| 990 | spin_unlock_irqrestore(&port->lock, flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 991 | |
Jiri Slaby | 38c5803 | 2012-06-04 13:35:22 +0200 | [diff] [blame] | 992 | wake_up_interruptible(&port->open_wait); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 993 | } |
| 994 | |
| 995 | /* |
| 996 | * Function ircomm_tty_send_xchar (tty, ch) |
| 997 | * |
| 998 | * This routine is used to send a high-priority XON/XOFF character to |
| 999 | * the device. |
| 1000 | */ |
| 1001 | static void ircomm_tty_send_xchar(struct tty_struct *tty, char ch) |
| 1002 | { |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 1003 | IRDA_DEBUG(0, "%s(), not impl\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1004 | } |
| 1005 | |
| 1006 | /* |
| 1007 | * Function ircomm_tty_start (tty) |
| 1008 | * |
| 1009 | * This routine notifies the tty driver that it resume sending |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1010 | * characters to the tty device. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1011 | */ |
| 1012 | void ircomm_tty_start(struct tty_struct *tty) |
| 1013 | { |
| 1014 | struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data; |
| 1015 | |
| 1016 | ircomm_flow_request(self->ircomm, FLOW_START); |
| 1017 | } |
| 1018 | |
| 1019 | /* |
| 1020 | * Function ircomm_tty_stop (tty) |
| 1021 | * |
| 1022 | * This routine notifies the tty driver that it should stop outputting |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1023 | * characters to the tty device. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1024 | */ |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1025 | static void ircomm_tty_stop(struct tty_struct *tty) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1026 | { |
| 1027 | struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) tty->driver_data; |
| 1028 | |
| 1029 | IRDA_ASSERT(self != NULL, return;); |
| 1030 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;); |
| 1031 | |
| 1032 | ircomm_flow_request(self->ircomm, FLOW_STOP); |
| 1033 | } |
| 1034 | |
| 1035 | /* |
| 1036 | * Function ircomm_check_modem_status (self) |
| 1037 | * |
| 1038 | * Check for any changes in the DCE's line settings. This function should |
| 1039 | * be called whenever the dce parameter settings changes, to update the |
| 1040 | * flow control settings and other things |
| 1041 | */ |
| 1042 | void ircomm_tty_check_modem_status(struct ircomm_tty_cb *self) |
| 1043 | { |
| 1044 | struct tty_struct *tty; |
| 1045 | int status; |
| 1046 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 1047 | IRDA_DEBUG(0, "%s()\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1048 | |
| 1049 | IRDA_ASSERT(self != NULL, return;); |
| 1050 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;); |
| 1051 | |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 1052 | tty = tty_port_tty_get(&self->port); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1053 | |
| 1054 | status = self->settings.dce; |
| 1055 | |
| 1056 | if (status & IRCOMM_DCE_DELTA_ANY) { |
| 1057 | /*wake_up_interruptible(&self->delta_msr_wait);*/ |
| 1058 | } |
Jiri Slaby | 849d5a9 | 2012-06-04 13:35:19 +0200 | [diff] [blame] | 1059 | if ((self->port.flags & ASYNC_CHECK_CD) && (status & IRCOMM_DELTA_CD)) { |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1060 | IRDA_DEBUG(2, |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 1061 | "%s(), ircomm%d CD now %s...\n", __func__ , self->line, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1062 | (status & IRCOMM_CD) ? "on" : "off"); |
| 1063 | |
| 1064 | if (status & IRCOMM_CD) { |
Jiri Slaby | a3cc9fc | 2012-06-04 13:35:16 +0200 | [diff] [blame] | 1065 | wake_up_interruptible(&self->port.open_wait); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1066 | } else { |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1067 | IRDA_DEBUG(2, |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 1068 | "%s(), Doing serial hangup..\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1069 | if (tty) |
| 1070 | tty_hangup(tty); |
| 1071 | |
| 1072 | /* Hangup will remote the tty, so better break out */ |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 1073 | goto put; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1074 | } |
| 1075 | } |
Huang Shijie | f21ec3d | 2012-08-22 22:13:36 -0400 | [diff] [blame] | 1076 | if (tty && tty_port_cts_enabled(&self->port)) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1077 | if (tty->hw_stopped) { |
| 1078 | if (status & IRCOMM_CTS) { |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1079 | IRDA_DEBUG(2, |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 1080 | "%s(), CTS tx start...\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1081 | tty->hw_stopped = 0; |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1082 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1083 | /* Wake up processes blocked on open */ |
Jiri Slaby | a3cc9fc | 2012-06-04 13:35:16 +0200 | [diff] [blame] | 1084 | wake_up_interruptible(&self->port.open_wait); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1085 | |
| 1086 | schedule_work(&self->tqueue); |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 1087 | goto put; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1088 | } |
| 1089 | } else { |
| 1090 | if (!(status & IRCOMM_CTS)) { |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1091 | IRDA_DEBUG(2, |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 1092 | "%s(), CTS tx stop...\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1093 | tty->hw_stopped = 1; |
| 1094 | } |
| 1095 | } |
| 1096 | } |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 1097 | put: |
| 1098 | tty_kref_put(tty); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1099 | } |
| 1100 | |
| 1101 | /* |
| 1102 | * Function ircomm_tty_data_indication (instance, sap, skb) |
| 1103 | * |
| 1104 | * Handle incoming data, and deliver it to the line discipline |
| 1105 | * |
| 1106 | */ |
| 1107 | static int ircomm_tty_data_indication(void *instance, void *sap, |
| 1108 | struct sk_buff *skb) |
| 1109 | { |
| 1110 | struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance; |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 1111 | struct tty_struct *tty; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1112 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 1113 | IRDA_DEBUG(2, "%s()\n", __func__ ); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1114 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1115 | IRDA_ASSERT(self != NULL, return -1;); |
| 1116 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;); |
| 1117 | IRDA_ASSERT(skb != NULL, return -1;); |
| 1118 | |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 1119 | tty = tty_port_tty_get(&self->port); |
| 1120 | if (!tty) { |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 1121 | IRDA_DEBUG(0, "%s(), no tty!\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1122 | return 0; |
| 1123 | } |
| 1124 | |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1125 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1126 | * If we receive data when hardware is stopped then something is wrong. |
| 1127 | * We try to poll the peers line settings to check if we are up todate. |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1128 | * Devices like WinCE can do this, and since they don't send any |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1129 | * params, we can just as well declare the hardware for running. |
| 1130 | */ |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 1131 | if (tty->hw_stopped && (self->flow == FLOW_START)) { |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 1132 | IRDA_DEBUG(0, "%s(), polling for line settings!\n", __func__ ); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1133 | ircomm_param_request(self, IRCOMM_POLL, TRUE); |
| 1134 | |
| 1135 | /* We can just as well declare the hardware for running */ |
| 1136 | ircomm_tty_send_initial_parameters(self); |
| 1137 | ircomm_tty_link_established(self); |
| 1138 | } |
Jiri Slaby | 2e124b4 | 2013-01-03 15:53:06 +0100 | [diff] [blame^] | 1139 | tty_kref_put(tty); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1140 | |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1141 | /* |
Amit Virdi | cbfd152 | 2011-05-12 01:04:40 +0000 | [diff] [blame] | 1142 | * Use flip buffer functions since the code may be called from interrupt |
| 1143 | * context |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1144 | */ |
Jiri Slaby | 05c7cd3 | 2013-01-03 15:53:04 +0100 | [diff] [blame] | 1145 | tty_insert_flip_string(&self->port, skb->data, skb->len); |
Jiri Slaby | 2e124b4 | 2013-01-03 15:53:06 +0100 | [diff] [blame^] | 1146 | tty_flip_buffer_push(&self->port); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1147 | |
| 1148 | /* No need to kfree_skb - see ircomm_ttp_data_indication() */ |
| 1149 | |
| 1150 | return 0; |
| 1151 | } |
| 1152 | |
| 1153 | /* |
| 1154 | * Function ircomm_tty_control_indication (instance, sap, skb) |
| 1155 | * |
| 1156 | * Parse all incoming parameters (easy!) |
| 1157 | * |
| 1158 | */ |
| 1159 | static int ircomm_tty_control_indication(void *instance, void *sap, |
| 1160 | struct sk_buff *skb) |
| 1161 | { |
| 1162 | struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance; |
| 1163 | int clen; |
| 1164 | |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 1165 | IRDA_DEBUG(4, "%s()\n", __func__ ); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1166 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1167 | IRDA_ASSERT(self != NULL, return -1;); |
| 1168 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return -1;); |
| 1169 | IRDA_ASSERT(skb != NULL, return -1;); |
| 1170 | |
| 1171 | clen = skb->data[0]; |
| 1172 | |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1173 | irda_param_extract_all(self, skb->data+1, IRDA_MIN(skb->len-1, clen), |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1174 | &ircomm_param_info); |
| 1175 | |
| 1176 | /* No need to kfree_skb - see ircomm_control_indication() */ |
| 1177 | |
| 1178 | return 0; |
| 1179 | } |
| 1180 | |
| 1181 | /* |
| 1182 | * Function ircomm_tty_flow_indication (instance, sap, cmd) |
| 1183 | * |
| 1184 | * This function is called by IrTTP when it wants us to slow down the |
| 1185 | * transmission of data. We just mark the hardware as stopped, and wait |
| 1186 | * for IrTTP to notify us that things are OK again. |
| 1187 | */ |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1188 | static void ircomm_tty_flow_indication(void *instance, void *sap, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1189 | LOCAL_FLOW cmd) |
| 1190 | { |
| 1191 | struct ircomm_tty_cb *self = (struct ircomm_tty_cb *) instance; |
| 1192 | struct tty_struct *tty; |
| 1193 | |
| 1194 | IRDA_ASSERT(self != NULL, return;); |
| 1195 | IRDA_ASSERT(self->magic == IRCOMM_TTY_MAGIC, return;); |
| 1196 | |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 1197 | tty = tty_port_tty_get(&self->port); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1198 | |
| 1199 | switch (cmd) { |
| 1200 | case FLOW_START: |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 1201 | IRDA_DEBUG(2, "%s(), hw start!\n", __func__ ); |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 1202 | if (tty) |
| 1203 | tty->hw_stopped = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1204 | |
| 1205 | /* ircomm_tty_do_softint will take care of the rest */ |
| 1206 | schedule_work(&self->tqueue); |
| 1207 | break; |
| 1208 | default: /* If we get here, something is very wrong, better stop */ |
| 1209 | case FLOW_STOP: |
Harvey Harrison | 0dc4787 | 2008-03-05 20:47:47 -0800 | [diff] [blame] | 1210 | IRDA_DEBUG(2, "%s(), hw stopped!\n", __func__ ); |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 1211 | if (tty) |
| 1212 | tty->hw_stopped = 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1213 | break; |
| 1214 | } |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 1215 | |
| 1216 | tty_kref_put(tty); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1217 | self->flow = cmd; |
| 1218 | } |
| 1219 | |
Pavel Emelyanov | 92b05e13 | 2007-12-05 02:18:48 -0800 | [diff] [blame] | 1220 | #ifdef CONFIG_PROC_FS |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1221 | static void ircomm_tty_line_info(struct ircomm_tty_cb *self, struct seq_file *m) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1222 | { |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 1223 | struct tty_struct *tty; |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1224 | char sep; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1225 | |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1226 | seq_printf(m, "State: %s\n", ircomm_tty_state[self->state]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1227 | |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1228 | seq_puts(m, "Service type: "); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1229 | if (self->service_type & IRCOMM_9_WIRE) |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1230 | seq_puts(m, "9_WIRE"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1231 | else if (self->service_type & IRCOMM_3_WIRE) |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1232 | seq_puts(m, "3_WIRE"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1233 | else if (self->service_type & IRCOMM_3_WIRE_RAW) |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1234 | seq_puts(m, "3_WIRE_RAW"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1235 | else |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1236 | seq_puts(m, "No common service type!\n"); |
| 1237 | seq_putc(m, '\n'); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1238 | |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1239 | seq_printf(m, "Port name: %s\n", self->settings.port_name); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1240 | |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1241 | seq_printf(m, "DTE status:"); |
| 1242 | sep = ' '; |
| 1243 | if (self->settings.dte & IRCOMM_RTS) { |
| 1244 | seq_printf(m, "%cRTS", sep); |
| 1245 | sep = '|'; |
| 1246 | } |
| 1247 | if (self->settings.dte & IRCOMM_DTR) { |
| 1248 | seq_printf(m, "%cDTR", sep); |
| 1249 | sep = '|'; |
| 1250 | } |
| 1251 | seq_putc(m, '\n'); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1252 | |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1253 | seq_puts(m, "DCE status:"); |
| 1254 | sep = ' '; |
| 1255 | if (self->settings.dce & IRCOMM_CTS) { |
| 1256 | seq_printf(m, "%cCTS", sep); |
| 1257 | sep = '|'; |
| 1258 | } |
| 1259 | if (self->settings.dce & IRCOMM_DSR) { |
| 1260 | seq_printf(m, "%cDSR", sep); |
| 1261 | sep = '|'; |
| 1262 | } |
| 1263 | if (self->settings.dce & IRCOMM_CD) { |
| 1264 | seq_printf(m, "%cCD", sep); |
| 1265 | sep = '|'; |
| 1266 | } |
| 1267 | if (self->settings.dce & IRCOMM_RI) { |
| 1268 | seq_printf(m, "%cRI", sep); |
| 1269 | sep = '|'; |
| 1270 | } |
| 1271 | seq_putc(m, '\n'); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1272 | |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1273 | seq_puts(m, "Configuration: "); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1274 | if (!self->settings.null_modem) |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1275 | seq_puts(m, "DTE <-> DCE\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1276 | else |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1277 | seq_puts(m, "DTE <-> DTE (null modem emulation)\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1278 | |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1279 | seq_printf(m, "Data rate: %d\n", self->settings.data_rate); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1280 | |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1281 | seq_puts(m, "Flow control:"); |
| 1282 | sep = ' '; |
| 1283 | if (self->settings.flow_control & IRCOMM_XON_XOFF_IN) { |
| 1284 | seq_printf(m, "%cXON_XOFF_IN", sep); |
| 1285 | sep = '|'; |
| 1286 | } |
| 1287 | if (self->settings.flow_control & IRCOMM_XON_XOFF_OUT) { |
| 1288 | seq_printf(m, "%cXON_XOFF_OUT", sep); |
| 1289 | sep = '|'; |
| 1290 | } |
| 1291 | if (self->settings.flow_control & IRCOMM_RTS_CTS_IN) { |
| 1292 | seq_printf(m, "%cRTS_CTS_IN", sep); |
| 1293 | sep = '|'; |
| 1294 | } |
| 1295 | if (self->settings.flow_control & IRCOMM_RTS_CTS_OUT) { |
| 1296 | seq_printf(m, "%cRTS_CTS_OUT", sep); |
| 1297 | sep = '|'; |
| 1298 | } |
| 1299 | if (self->settings.flow_control & IRCOMM_DSR_DTR_IN) { |
| 1300 | seq_printf(m, "%cDSR_DTR_IN", sep); |
| 1301 | sep = '|'; |
| 1302 | } |
| 1303 | if (self->settings.flow_control & IRCOMM_DSR_DTR_OUT) { |
| 1304 | seq_printf(m, "%cDSR_DTR_OUT", sep); |
| 1305 | sep = '|'; |
| 1306 | } |
| 1307 | if (self->settings.flow_control & IRCOMM_ENQ_ACK_IN) { |
| 1308 | seq_printf(m, "%cENQ_ACK_IN", sep); |
| 1309 | sep = '|'; |
| 1310 | } |
| 1311 | if (self->settings.flow_control & IRCOMM_ENQ_ACK_OUT) { |
| 1312 | seq_printf(m, "%cENQ_ACK_OUT", sep); |
| 1313 | sep = '|'; |
| 1314 | } |
| 1315 | seq_putc(m, '\n'); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1316 | |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1317 | seq_puts(m, "Flags:"); |
| 1318 | sep = ' '; |
Huang Shijie | f21ec3d | 2012-08-22 22:13:36 -0400 | [diff] [blame] | 1319 | if (tty_port_cts_enabled(&self->port)) { |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1320 | seq_printf(m, "%cASYNC_CTS_FLOW", sep); |
| 1321 | sep = '|'; |
| 1322 | } |
Jiri Slaby | 849d5a9 | 2012-06-04 13:35:19 +0200 | [diff] [blame] | 1323 | if (self->port.flags & ASYNC_CHECK_CD) { |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1324 | seq_printf(m, "%cASYNC_CHECK_CD", sep); |
| 1325 | sep = '|'; |
| 1326 | } |
Jiri Slaby | 849d5a9 | 2012-06-04 13:35:19 +0200 | [diff] [blame] | 1327 | if (self->port.flags & ASYNC_INITIALIZED) { |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1328 | seq_printf(m, "%cASYNC_INITIALIZED", sep); |
| 1329 | sep = '|'; |
| 1330 | } |
Jiri Slaby | 849d5a9 | 2012-06-04 13:35:19 +0200 | [diff] [blame] | 1331 | if (self->port.flags & ASYNC_LOW_LATENCY) { |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1332 | seq_printf(m, "%cASYNC_LOW_LATENCY", sep); |
| 1333 | sep = '|'; |
| 1334 | } |
Jiri Slaby | 849d5a9 | 2012-06-04 13:35:19 +0200 | [diff] [blame] | 1335 | if (self->port.flags & ASYNC_CLOSING) { |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1336 | seq_printf(m, "%cASYNC_CLOSING", sep); |
| 1337 | sep = '|'; |
| 1338 | } |
Jiri Slaby | 849d5a9 | 2012-06-04 13:35:19 +0200 | [diff] [blame] | 1339 | if (self->port.flags & ASYNC_NORMAL_ACTIVE) { |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1340 | seq_printf(m, "%cASYNC_NORMAL_ACTIVE", sep); |
| 1341 | sep = '|'; |
| 1342 | } |
| 1343 | seq_putc(m, '\n'); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1344 | |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1345 | seq_printf(m, "Role: %s\n", self->client ? "client" : "server"); |
Jiri Slaby | 580d27b | 2012-06-04 13:35:18 +0200 | [diff] [blame] | 1346 | seq_printf(m, "Open count: %d\n", self->port.count); |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1347 | seq_printf(m, "Max data size: %d\n", self->max_data_size); |
| 1348 | seq_printf(m, "Max header size: %d\n", self->max_header_size); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1349 | |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 1350 | tty = tty_port_tty_get(&self->port); |
| 1351 | if (tty) { |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1352 | seq_printf(m, "Hardware: %s\n", |
Jiri Slaby | 62f228a | 2012-06-04 13:35:21 +0200 | [diff] [blame] | 1353 | tty->hw_stopped ? "Stopped" : "Running"); |
| 1354 | tty_kref_put(tty); |
| 1355 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1356 | } |
| 1357 | |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1358 | static int ircomm_tty_proc_show(struct seq_file *m, void *v) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1359 | { |
| 1360 | struct ircomm_tty_cb *self; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1361 | unsigned long flags; |
| 1362 | |
| 1363 | spin_lock_irqsave(&ircomm_tty->hb_spinlock, flags); |
| 1364 | |
| 1365 | self = (struct ircomm_tty_cb *) hashbin_get_first(ircomm_tty); |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1366 | while (self != NULL) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1367 | if (self->magic != IRCOMM_TTY_MAGIC) |
| 1368 | break; |
| 1369 | |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1370 | ircomm_tty_line_info(self, m); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1371 | self = (struct ircomm_tty_cb *) hashbin_get_next(ircomm_tty); |
YOSHIFUJI Hideaki | 6819bc2 | 2007-02-09 23:24:53 +0900 | [diff] [blame] | 1372 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1373 | spin_unlock_irqrestore(&ircomm_tty->hb_spinlock, flags); |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1374 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1375 | } |
Alexey Dobriyan | 3d30417 | 2009-03-31 15:19:22 -0700 | [diff] [blame] | 1376 | |
| 1377 | static int ircomm_tty_proc_open(struct inode *inode, struct file *file) |
| 1378 | { |
| 1379 | return single_open(file, ircomm_tty_proc_show, NULL); |
| 1380 | } |
| 1381 | |
| 1382 | static const struct file_operations ircomm_tty_proc_fops = { |
| 1383 | .owner = THIS_MODULE, |
| 1384 | .open = ircomm_tty_proc_open, |
| 1385 | .read = seq_read, |
| 1386 | .llseek = seq_lseek, |
| 1387 | .release = single_release, |
| 1388 | }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1389 | #endif /* CONFIG_PROC_FS */ |
| 1390 | |
| 1391 | MODULE_AUTHOR("Dag Brattli <dagb@cs.uit.no>"); |
| 1392 | MODULE_DESCRIPTION("IrCOMM serial TTY driver"); |
| 1393 | MODULE_LICENSE("GPL"); |
| 1394 | MODULE_ALIAS_CHARDEV_MAJOR(IRCOMM_TTY_MAJOR); |
| 1395 | |
| 1396 | module_init(ircomm_tty_init); |
| 1397 | module_exit(ircomm_tty_cleanup); |