1 /* 2 * IPWireless 3G PCMCIA Network Driver 3 * 4 * Original code 5 * by Stephen Blackheath <stephen@blacksapphire.com>, 6 * Ben Martel <benm@symmetric.co.nz> 7 * 8 * Copyrighted as follows: 9 * Copyright (C) 2004 by Symmetric Systems Ltd (NZ) 10 * 11 * Various driver changes and rewrites, port to new kernels 12 * Copyright (C) 2006-2007 Jiri Kosina 13 * 14 * Misc code cleanups and updates 15 * Copyright (C) 2007 David Sterba 16 */ 17 18 #include <linux/init.h> 19 #include <linux/kernel.h> 20 #include <linux/module.h> 21 #include <linux/mutex.h> 22 #include <linux/ppp_defs.h> 23 #include <linux/if.h> 24 #include <linux/ppp-ioctl.h> 25 #include <linux/sched.h> 26 #include <linux/serial.h> 27 #include <linux/slab.h> 28 #include <linux/tty.h> 29 #include <linux/tty_driver.h> 30 #include <linux/tty_flip.h> 31 #include <linux/uaccess.h> 32 33 #include "tty.h" 34 #include "network.h" 35 #include "hardware.h" 36 #include "main.h" 37 38 #define IPWIRELESS_PCMCIA_START (0) 39 #define IPWIRELESS_PCMCIA_MINORS (24) 40 #define IPWIRELESS_PCMCIA_MINOR_RANGE (8) 41 42 #define TTYTYPE_MODEM (0) 43 #define TTYTYPE_MONITOR (1) 44 #define TTYTYPE_RAS_RAW (2) 45 46 struct ipw_tty { 47 struct tty_port port; 48 int index; 49 struct ipw_hardware *hardware; 50 unsigned int channel_idx; 51 unsigned int secondary_channel_idx; 52 int tty_type; 53 struct ipw_network *network; 54 unsigned int control_lines; 55 struct mutex ipw_tty_mutex; 56 int tx_bytes_queued; 57 int closing; 58 }; 59 60 static struct ipw_tty *ttys[IPWIRELESS_PCMCIA_MINORS]; 61 62 static struct tty_driver *ipw_tty_driver; 63 64 static char *tty_type_name(int tty_type) 65 { 66 static char *channel_names[] = { 67 "modem", 68 "monitor", 69 "RAS-raw" 70 }; 71 72 return channel_names[tty_type]; 73 } 74 75 static struct ipw_tty *get_tty(int index) 76 { 77 /* 78 * The 'ras_raw' channel is only available when 'loopback' mode 79 * is enabled. 80 * Number of minor starts with 16 (_RANGE * _RAS_RAW). 81 */ 82 if (!ipwireless_loopback && index >= 83 IPWIRELESS_PCMCIA_MINOR_RANGE * TTYTYPE_RAS_RAW) 84 return NULL; 85 86 return ttys[index]; 87 } 88 89 static int ipw_open(struct tty_struct *linux_tty, struct file *filp) 90 { 91 struct ipw_tty *tty = get_tty(linux_tty->index); 92 93 if (!tty) 94 return -ENODEV; 95 96 mutex_lock(&tty->ipw_tty_mutex); 97 98 if (tty->closing) { 99 mutex_unlock(&tty->ipw_tty_mutex); 100 return -ENODEV; 101 } 102 if (tty->port.count == 0) 103 tty->tx_bytes_queued = 0; 104 105 tty->port.count++; 106 107 tty->port.tty = linux_tty; 108 linux_tty->driver_data = tty; 109 linux_tty->low_latency = 1; 110 111 if (tty->tty_type == TTYTYPE_MODEM) 112 ipwireless_ppp_open(tty->network); 113 114 mutex_unlock(&tty->ipw_tty_mutex); 115 116 return 0; 117 } 118 119 static void do_ipw_close(struct ipw_tty *tty) 120 { 121 tty->port.count--; 122 123 if (tty->port.count == 0) { 124 struct tty_struct *linux_tty = tty->port.tty; 125 126 if (linux_tty != NULL) { 127 tty->port.tty = NULL; 128 linux_tty->driver_data = NULL; 129 130 if (tty->tty_type == TTYTYPE_MODEM) 131 ipwireless_ppp_close(tty->network); 132 } 133 } 134 } 135 136 static void ipw_hangup(struct tty_struct *linux_tty) 137 { 138 struct ipw_tty *tty = linux_tty->driver_data; 139 140 if (!tty) 141 return; 142 143 mutex_lock(&tty->ipw_tty_mutex); 144 if (tty->port.count == 0) { 145 mutex_unlock(&tty->ipw_tty_mutex); 146 return; 147 } 148 149 do_ipw_close(tty); 150 151 mutex_unlock(&tty->ipw_tty_mutex); 152 } 153 154 static void ipw_close(struct tty_struct *linux_tty, struct file *filp) 155 { 156 ipw_hangup(linux_tty); 157 } 158 159 /* Take data received from hardware, and send it out the tty */ 160 void ipwireless_tty_received(struct ipw_tty *tty, unsigned char *data, 161 unsigned int length) 162 { 163 struct tty_struct *linux_tty; 164 int work = 0; 165 166 mutex_lock(&tty->ipw_tty_mutex); 167 linux_tty = tty->port.tty; 168 if (linux_tty == NULL) { 169 mutex_unlock(&tty->ipw_tty_mutex); 170 return; 171 } 172 173 if (!tty->port.count) { 174 mutex_unlock(&tty->ipw_tty_mutex); 175 return; 176 } 177 mutex_unlock(&tty->ipw_tty_mutex); 178 179 work = tty_insert_flip_string(linux_tty, data, length); 180 181 if (work != length) 182 printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME 183 ": %d chars not inserted to flip buffer!\n", 184 length - work); 185 186 /* 187 * This may sleep if ->low_latency is set 188 */ 189 if (work) 190 tty_flip_buffer_push(linux_tty); 191 } 192 193 static void ipw_write_packet_sent_callback(void *callback_data, 194 unsigned int packet_length) 195 { 196 struct ipw_tty *tty = callback_data; 197 198 /* 199 * Packet has been sent, so we subtract the number of bytes from our 200 * tally of outstanding TX bytes. 201 */ 202 tty->tx_bytes_queued -= packet_length; 203 } 204 205 static int ipw_write(struct tty_struct *linux_tty, 206 const unsigned char *buf, int count) 207 { 208 struct ipw_tty *tty = linux_tty->driver_data; 209 int room, ret; 210 211 if (!tty) 212 return -ENODEV; 213 214 mutex_lock(&tty->ipw_tty_mutex); 215 if (!tty->port.count) { 216 mutex_unlock(&tty->ipw_tty_mutex); 217 return -EINVAL; 218 } 219 220 room = IPWIRELESS_TX_QUEUE_SIZE - tty->tx_bytes_queued; 221 if (room < 0) 222 room = 0; 223 /* Don't allow caller to write any more than we have room for */ 224 if (count > room) 225 count = room; 226 227 if (count == 0) { 228 mutex_unlock(&tty->ipw_tty_mutex); 229 return 0; 230 } 231 232 ret = ipwireless_send_packet(tty->hardware, IPW_CHANNEL_RAS, 233 buf, count, 234 ipw_write_packet_sent_callback, tty); 235 if (ret == -1) { 236 mutex_unlock(&tty->ipw_tty_mutex); 237 return 0; 238 } 239 240 tty->tx_bytes_queued += count; 241 mutex_unlock(&tty->ipw_tty_mutex); 242 243 return count; 244 } 245 246 static int ipw_write_room(struct tty_struct *linux_tty) 247 { 248 struct ipw_tty *tty = linux_tty->driver_data; 249 int room; 250 251 /* FIXME: Exactly how is the tty object locked here .. */ 252 if (!tty) 253 return -ENODEV; 254 255 if (!tty->port.count) 256 return -EINVAL; 257 258 room = IPWIRELESS_TX_QUEUE_SIZE - tty->tx_bytes_queued; 259 if (room < 0) 260 room = 0; 261 262 return room; 263 } 264 265 static int ipwireless_get_serial_info(struct ipw_tty *tty, 266 struct serial_struct __user *retinfo) 267 { 268 struct serial_struct tmp; 269 270 if (!retinfo) 271 return (-EFAULT); 272 273 memset(&tmp, 0, sizeof(tmp)); 274 tmp.type = PORT_UNKNOWN; 275 tmp.line = tty->index; 276 tmp.port = 0; 277 tmp.irq = 0; 278 tmp.flags = 0; 279 tmp.baud_base = 115200; 280 tmp.close_delay = 0; 281 tmp.closing_wait = 0; 282 tmp.custom_divisor = 0; 283 tmp.hub6 = 0; 284 if (copy_to_user(retinfo, &tmp, sizeof(*retinfo))) 285 return -EFAULT; 286 287 return 0; 288 } 289 290 static int ipw_chars_in_buffer(struct tty_struct *linux_tty) 291 { 292 struct ipw_tty *tty = linux_tty->driver_data; 293 294 if (!tty) 295 return 0; 296 297 if (!tty->port.count) 298 return 0; 299 300 return tty->tx_bytes_queued; 301 } 302 303 static int get_control_lines(struct ipw_tty *tty) 304 { 305 unsigned int my = tty->control_lines; 306 unsigned int out = 0; 307 308 if (my & IPW_CONTROL_LINE_RTS) 309 out |= TIOCM_RTS; 310 if (my & IPW_CONTROL_LINE_DTR) 311 out |= TIOCM_DTR; 312 if (my & IPW_CONTROL_LINE_CTS) 313 out |= TIOCM_CTS; 314 if (my & IPW_CONTROL_LINE_DSR) 315 out |= TIOCM_DSR; 316 if (my & IPW_CONTROL_LINE_DCD) 317 out |= TIOCM_CD; 318 319 return out; 320 } 321 322 static int set_control_lines(struct ipw_tty *tty, unsigned int set, 323 unsigned int clear) 324 { 325 int ret; 326 327 if (set & TIOCM_RTS) { 328 ret = ipwireless_set_RTS(tty->hardware, tty->channel_idx, 1); 329 if (ret) 330 return ret; 331 if (tty->secondary_channel_idx != -1) { 332 ret = ipwireless_set_RTS(tty->hardware, 333 tty->secondary_channel_idx, 1); 334 if (ret) 335 return ret; 336 } 337 } 338 if (set & TIOCM_DTR) { 339 ret = ipwireless_set_DTR(tty->hardware, tty->channel_idx, 1); 340 if (ret) 341 return ret; 342 if (tty->secondary_channel_idx != -1) { 343 ret = ipwireless_set_DTR(tty->hardware, 344 tty->secondary_channel_idx, 1); 345 if (ret) 346 return ret; 347 } 348 } 349 if (clear & TIOCM_RTS) { 350 ret = ipwireless_set_RTS(tty->hardware, tty->channel_idx, 0); 351 if (tty->secondary_channel_idx != -1) { 352 ret = ipwireless_set_RTS(tty->hardware, 353 tty->secondary_channel_idx, 0); 354 if (ret) 355 return ret; 356 } 357 } 358 if (clear & TIOCM_DTR) { 359 ret = ipwireless_set_DTR(tty->hardware, tty->channel_idx, 0); 360 if (tty->secondary_channel_idx != -1) { 361 ret = ipwireless_set_DTR(tty->hardware, 362 tty->secondary_channel_idx, 0); 363 if (ret) 364 return ret; 365 } 366 } 367 return 0; 368 } 369 370 static int ipw_tiocmget(struct tty_struct *linux_tty) 371 { 372 struct ipw_tty *tty = linux_tty->driver_data; 373 /* FIXME: Exactly how is the tty object locked here .. */ 374 375 if (!tty) 376 return -ENODEV; 377 378 if (!tty->port.count) 379 return -EINVAL; 380 381 return get_control_lines(tty); 382 } 383 384 static int 385 ipw_tiocmset(struct tty_struct *linux_tty, 386 unsigned int set, unsigned int clear) 387 { 388 struct ipw_tty *tty = linux_tty->driver_data; 389 /* FIXME: Exactly how is the tty object locked here .. */ 390 391 if (!tty) 392 return -ENODEV; 393 394 if (!tty->port.count) 395 return -EINVAL; 396 397 return set_control_lines(tty, set, clear); 398 } 399 400 static int ipw_ioctl(struct tty_struct *linux_tty, 401 unsigned int cmd, unsigned long arg) 402 { 403 struct ipw_tty *tty = linux_tty->driver_data; 404 405 if (!tty) 406 return -ENODEV; 407 408 if (!tty->port.count) 409 return -EINVAL; 410 411 /* FIXME: Exactly how is the tty object locked here .. */ 412 413 switch (cmd) { 414 case TIOCGSERIAL: 415 return ipwireless_get_serial_info(tty, (void __user *) arg); 416 417 case TIOCSSERIAL: 418 return 0; /* Keeps the PCMCIA scripts happy. */ 419 } 420 421 if (tty->tty_type == TTYTYPE_MODEM) { 422 switch (cmd) { 423 case PPPIOCGCHAN: 424 { 425 int chan = ipwireless_ppp_channel_index( 426 tty->network); 427 428 if (chan < 0) 429 return -ENODEV; 430 if (put_user(chan, (int __user *) arg)) 431 return -EFAULT; 432 } 433 return 0; 434 435 case PPPIOCGUNIT: 436 { 437 int unit = ipwireless_ppp_unit_number( 438 tty->network); 439 440 if (unit < 0) 441 return -ENODEV; 442 if (put_user(unit, (int __user *) arg)) 443 return -EFAULT; 444 } 445 return 0; 446 447 case FIONREAD: 448 { 449 int val = 0; 450 451 if (put_user(val, (int __user *) arg)) 452 return -EFAULT; 453 } 454 return 0; 455 case TCFLSH: 456 return tty_perform_flush(linux_tty, arg); 457 } 458 } 459 return -ENOIOCTLCMD; 460 } 461 462 static int add_tty(int j, 463 struct ipw_hardware *hardware, 464 struct ipw_network *network, int channel_idx, 465 int secondary_channel_idx, int tty_type) 466 { 467 ttys[j] = kzalloc(sizeof(struct ipw_tty), GFP_KERNEL); 468 if (!ttys[j]) 469 return -ENOMEM; 470 ttys[j]->index = j; 471 ttys[j]->hardware = hardware; 472 ttys[j]->channel_idx = channel_idx; 473 ttys[j]->secondary_channel_idx = secondary_channel_idx; 474 ttys[j]->network = network; 475 ttys[j]->tty_type = tty_type; 476 mutex_init(&ttys[j]->ipw_tty_mutex); 477 tty_port_init(&ttys[j]->port); 478 479 tty_port_register_device(&ttys[j]->port, ipw_tty_driver, j, NULL); 480 ipwireless_associate_network_tty(network, channel_idx, ttys[j]); 481 482 if (secondary_channel_idx != -1) 483 ipwireless_associate_network_tty(network, 484 secondary_channel_idx, 485 ttys[j]); 486 /* check if we provide raw device (if loopback is enabled) */ 487 if (get_tty(j)) 488 printk(KERN_INFO IPWIRELESS_PCCARD_NAME 489 ": registering %s device ttyIPWp%d\n", 490 tty_type_name(tty_type), j); 491 492 return 0; 493 } 494 495 struct ipw_tty *ipwireless_tty_create(struct ipw_hardware *hardware, 496 struct ipw_network *network) 497 { 498 int i, j; 499 500 for (i = 0; i < IPWIRELESS_PCMCIA_MINOR_RANGE; i++) { 501 int allfree = 1; 502 503 for (j = i; j < IPWIRELESS_PCMCIA_MINORS; 504 j += IPWIRELESS_PCMCIA_MINOR_RANGE) 505 if (ttys[j] != NULL) { 506 allfree = 0; 507 break; 508 } 509 510 if (allfree) { 511 j = i; 512 513 if (add_tty(j, hardware, network, 514 IPW_CHANNEL_DIALLER, IPW_CHANNEL_RAS, 515 TTYTYPE_MODEM)) 516 return NULL; 517 518 j += IPWIRELESS_PCMCIA_MINOR_RANGE; 519 if (add_tty(j, hardware, network, 520 IPW_CHANNEL_DIALLER, -1, 521 TTYTYPE_MONITOR)) 522 return NULL; 523 524 j += IPWIRELESS_PCMCIA_MINOR_RANGE; 525 if (add_tty(j, hardware, network, 526 IPW_CHANNEL_RAS, -1, 527 TTYTYPE_RAS_RAW)) 528 return NULL; 529 530 return ttys[i]; 531 } 532 } 533 return NULL; 534 } 535 536 /* 537 * Must be called before ipwireless_network_free(). 538 */ 539 void ipwireless_tty_free(struct ipw_tty *tty) 540 { 541 int j; 542 struct ipw_network *network = ttys[tty->index]->network; 543 544 for (j = tty->index; j < IPWIRELESS_PCMCIA_MINORS; 545 j += IPWIRELESS_PCMCIA_MINOR_RANGE) { 546 struct ipw_tty *ttyj = ttys[j]; 547 548 if (ttyj) { 549 mutex_lock(&ttyj->ipw_tty_mutex); 550 if (get_tty(j)) 551 printk(KERN_INFO IPWIRELESS_PCCARD_NAME 552 ": deregistering %s device ttyIPWp%d\n", 553 tty_type_name(ttyj->tty_type), j); 554 ttyj->closing = 1; 555 if (ttyj->port.tty != NULL) { 556 mutex_unlock(&ttyj->ipw_tty_mutex); 557 tty_vhangup(ttyj->port.tty); 558 /* FIXME: Exactly how is the tty object locked here 559 against a parallel ioctl etc */ 560 /* FIXME2: hangup does not mean all processes 561 * are gone */ 562 mutex_lock(&ttyj->ipw_tty_mutex); 563 } 564 while (ttyj->port.count) 565 do_ipw_close(ttyj); 566 ipwireless_disassociate_network_ttys(network, 567 ttyj->channel_idx); 568 tty_unregister_device(ipw_tty_driver, j); 569 ttys[j] = NULL; 570 mutex_unlock(&ttyj->ipw_tty_mutex); 571 kfree(ttyj); 572 } 573 } 574 } 575 576 static const struct tty_operations tty_ops = { 577 .open = ipw_open, 578 .close = ipw_close, 579 .hangup = ipw_hangup, 580 .write = ipw_write, 581 .write_room = ipw_write_room, 582 .ioctl = ipw_ioctl, 583 .chars_in_buffer = ipw_chars_in_buffer, 584 .tiocmget = ipw_tiocmget, 585 .tiocmset = ipw_tiocmset, 586 }; 587 588 int ipwireless_tty_init(void) 589 { 590 int result; 591 592 ipw_tty_driver = alloc_tty_driver(IPWIRELESS_PCMCIA_MINORS); 593 if (!ipw_tty_driver) 594 return -ENOMEM; 595 596 ipw_tty_driver->driver_name = IPWIRELESS_PCCARD_NAME; 597 ipw_tty_driver->name = "ttyIPWp"; 598 ipw_tty_driver->major = 0; 599 ipw_tty_driver->minor_start = IPWIRELESS_PCMCIA_START; 600 ipw_tty_driver->type = TTY_DRIVER_TYPE_SERIAL; 601 ipw_tty_driver->subtype = SERIAL_TYPE_NORMAL; 602 ipw_tty_driver->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV; 603 ipw_tty_driver->init_termios = tty_std_termios; 604 ipw_tty_driver->init_termios.c_cflag = 605 B9600 | CS8 | CREAD | HUPCL | CLOCAL; 606 ipw_tty_driver->init_termios.c_ispeed = 9600; 607 ipw_tty_driver->init_termios.c_ospeed = 9600; 608 tty_set_operations(ipw_tty_driver, &tty_ops); 609 result = tty_register_driver(ipw_tty_driver); 610 if (result) { 611 printk(KERN_ERR IPWIRELESS_PCCARD_NAME 612 ": failed to register tty driver\n"); 613 put_tty_driver(ipw_tty_driver); 614 return result; 615 } 616 617 return 0; 618 } 619 620 void ipwireless_tty_release(void) 621 { 622 int ret; 623 624 ret = tty_unregister_driver(ipw_tty_driver); 625 put_tty_driver(ipw_tty_driver); 626 if (ret != 0) 627 printk(KERN_ERR IPWIRELESS_PCCARD_NAME 628 ": tty_unregister_driver failed with code %d\n", ret); 629 } 630 631 int ipwireless_tty_is_modem(struct ipw_tty *tty) 632 { 633 return tty->tty_type == TTYTYPE_MODEM; 634 } 635 636 void 637 ipwireless_tty_notify_control_line_change(struct ipw_tty *tty, 638 unsigned int channel_idx, 639 unsigned int control_lines, 640 unsigned int changed_mask) 641 { 642 unsigned int old_control_lines = tty->control_lines; 643 644 tty->control_lines = (tty->control_lines & ~changed_mask) 645 | (control_lines & changed_mask); 646 647 /* 648 * If DCD is de-asserted, we close the tty so pppd can tell that we 649 * have gone offline. 650 */ 651 if ((old_control_lines & IPW_CONTROL_LINE_DCD) 652 && !(tty->control_lines & IPW_CONTROL_LINE_DCD) 653 && tty->port.tty) { 654 tty_hangup(tty->port.tty); 655 } 656 } 657 658