123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351 |
- /*
- * Copyright (c) 2012 GCT Semiconductor, Inc. All rights reserved.
- *
- * This software is licensed under the terms of the GNU General Public
- * License version 2, as published by the Free Software Foundation, and
- * may be copied, distributed, and modified under those terms.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- */
- #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
- #include <linux/kernel.h>
- #include <linux/errno.h>
- #include <linux/tty.h>
- #include <linux/tty_driver.h>
- #include <linux/tty_flip.h>
- #include <linux/module.h>
- #include <linux/slab.h>
- #include <linux/usb/cdc.h>
- #include <linux/serial.h>
- #include "gdm_tty.h"
- #define GDM_TTY_MAJOR 0
- #define GDM_TTY_MINOR 32
- #define ACM_CTRL_DTR 0x01
- #define ACM_CTRL_RTS 0x02
- #define ACM_CTRL_DSR 0x02
- #define ACM_CTRL_RI 0x08
- #define ACM_CTRL_DCD 0x01
- #define WRITE_SIZE 2048
- #define MUX_TX_MAX_SIZE 2048
- #define gdm_tty_send(n, d, l, i, c, b) (\
- n->tty_dev->send_func(n->tty_dev->priv_dev, d, l, i, c, b))
- #define gdm_tty_recv(n, c) (\
- n->tty_dev->recv_func(n->tty_dev->priv_dev, c))
- #define gdm_tty_send_control(n, r, v, d, l) (\
- n->tty_dev->send_control(n->tty_dev->priv_dev, r, v, d, l))
- #define GDM_TTY_READY(gdm) (gdm && gdm->tty_dev && gdm->port.count)
- static struct tty_driver *gdm_driver[TTY_MAX_COUNT];
- static struct gdm *gdm_table[TTY_MAX_COUNT][GDM_TTY_MINOR];
- static DEFINE_MUTEX(gdm_table_lock);
- static char *DRIVER_STRING[TTY_MAX_COUNT] = {"GCTATC", "GCTDM"};
- static char *DEVICE_STRING[TTY_MAX_COUNT] = {"GCT-ATC", "GCT-DM"};
- static void gdm_port_destruct(struct tty_port *port)
- {
- struct gdm *gdm = container_of(port, struct gdm, port);
- mutex_lock(&gdm_table_lock);
- gdm_table[gdm->index][gdm->minor] = NULL;
- mutex_unlock(&gdm_table_lock);
- kfree(gdm);
- }
- static struct tty_port_operations gdm_port_ops = {
- .destruct = gdm_port_destruct,
- };
- static int gdm_tty_install(struct tty_driver *driver, struct tty_struct *tty)
- {
- struct gdm *gdm = NULL;
- int ret;
- int i;
- int j;
- j = GDM_TTY_MINOR;
- for (i = 0; i < TTY_MAX_COUNT; i++) {
- if (!strcmp(tty->driver->driver_name, DRIVER_STRING[i])) {
- j = tty->index;
- break;
- }
- }
- if (j == GDM_TTY_MINOR)
- return -ENODEV;
- mutex_lock(&gdm_table_lock);
- gdm = gdm_table[i][j];
- if (!gdm) {
- mutex_unlock(&gdm_table_lock);
- return -ENODEV;
- }
- tty_port_get(&gdm->port);
- ret = tty_standard_install(driver, tty);
- if (ret) {
- tty_port_put(&gdm->port);
- mutex_unlock(&gdm_table_lock);
- return ret;
- }
- tty->driver_data = gdm;
- mutex_unlock(&gdm_table_lock);
- return 0;
- }
- static int gdm_tty_open(struct tty_struct *tty, struct file *filp)
- {
- struct gdm *gdm = tty->driver_data;
- return tty_port_open(&gdm->port, tty, filp);
- }
- static void gdm_tty_cleanup(struct tty_struct *tty)
- {
- struct gdm *gdm = tty->driver_data;
- tty_port_put(&gdm->port);
- }
- static void gdm_tty_hangup(struct tty_struct *tty)
- {
- struct gdm *gdm = tty->driver_data;
- tty_port_hangup(&gdm->port);
- }
- static void gdm_tty_close(struct tty_struct *tty, struct file *filp)
- {
- struct gdm *gdm = tty->driver_data;
- tty_port_close(&gdm->port, tty, filp);
- }
- static int gdm_tty_recv_complete(void *data,
- int len,
- int index,
- struct tty_dev *tty_dev,
- int complete)
- {
- struct gdm *gdm = tty_dev->gdm[index];
- if (!GDM_TTY_READY(gdm)) {
- if (complete == RECV_PACKET_PROCESS_COMPLETE)
- gdm_tty_recv(gdm, gdm_tty_recv_complete);
- return TO_HOST_PORT_CLOSE;
- }
- if (data && len) {
- if (tty_buffer_request_room(&gdm->port, len) == len) {
- tty_insert_flip_string(&gdm->port, data, len);
- tty_flip_buffer_push(&gdm->port);
- } else {
- return TO_HOST_BUFFER_REQUEST_FAIL;
- }
- }
- if (complete == RECV_PACKET_PROCESS_COMPLETE)
- gdm_tty_recv(gdm, gdm_tty_recv_complete);
- return 0;
- }
- static void gdm_tty_send_complete(void *arg)
- {
- struct gdm *gdm = arg;
- if (!GDM_TTY_READY(gdm))
- return;
- tty_port_tty_wakeup(&gdm->port);
- }
- static int gdm_tty_write(struct tty_struct *tty, const unsigned char *buf,
- int len)
- {
- struct gdm *gdm = tty->driver_data;
- int remain = len;
- int sent_len = 0;
- int sending_len = 0;
- if (!GDM_TTY_READY(gdm))
- return -ENODEV;
- if (!len)
- return 0;
- while (1) {
- sending_len = remain > MUX_TX_MAX_SIZE ? MUX_TX_MAX_SIZE :
- remain;
- gdm_tty_send(gdm,
- (void *)(buf + sent_len),
- sending_len,
- gdm->index,
- gdm_tty_send_complete,
- gdm
- );
- sent_len += sending_len;
- remain -= sending_len;
- if (remain <= 0)
- break;
- }
- return len;
- }
- static int gdm_tty_write_room(struct tty_struct *tty)
- {
- struct gdm *gdm = tty->driver_data;
- if (!GDM_TTY_READY(gdm))
- return -ENODEV;
- return WRITE_SIZE;
- }
- int register_lte_tty_device(struct tty_dev *tty_dev, struct device *device)
- {
- struct gdm *gdm;
- int i;
- int j;
- for (i = 0; i < TTY_MAX_COUNT; i++) {
- gdm = kmalloc(sizeof(*gdm), GFP_KERNEL);
- if (!gdm)
- return -ENOMEM;
- mutex_lock(&gdm_table_lock);
- for (j = 0; j < GDM_TTY_MINOR; j++) {
- if (!gdm_table[i][j])
- break;
- }
- if (j == GDM_TTY_MINOR) {
- kfree(gdm);
- mutex_unlock(&gdm_table_lock);
- return -EINVAL;
- }
- gdm_table[i][j] = gdm;
- mutex_unlock(&gdm_table_lock);
- tty_dev->gdm[i] = gdm;
- tty_port_init(&gdm->port);
- gdm->port.ops = &gdm_port_ops;
- gdm->index = i;
- gdm->minor = j;
- gdm->tty_dev = tty_dev;
- tty_port_register_device(&gdm->port, gdm_driver[i],
- gdm->minor, device);
- }
- for (i = 0; i < MAX_ISSUE_NUM; i++)
- gdm_tty_recv(gdm, gdm_tty_recv_complete);
- return 0;
- }
- void unregister_lte_tty_device(struct tty_dev *tty_dev)
- {
- struct gdm *gdm;
- struct tty_struct *tty;
- int i;
- for (i = 0; i < TTY_MAX_COUNT; i++) {
- gdm = tty_dev->gdm[i];
- if (!gdm)
- continue;
- mutex_lock(&gdm_table_lock);
- gdm_table[gdm->index][gdm->minor] = NULL;
- mutex_unlock(&gdm_table_lock);
- tty = tty_port_tty_get(&gdm->port);
- if (tty) {
- tty_vhangup(tty);
- tty_kref_put(tty);
- }
- tty_unregister_device(gdm_driver[i], gdm->minor);
- tty_port_put(&gdm->port);
- }
- }
- static const struct tty_operations gdm_tty_ops = {
- .install = gdm_tty_install,
- .open = gdm_tty_open,
- .close = gdm_tty_close,
- .cleanup = gdm_tty_cleanup,
- .hangup = gdm_tty_hangup,
- .write = gdm_tty_write,
- .write_room = gdm_tty_write_room,
- };
- int register_lte_tty_driver(void)
- {
- struct tty_driver *tty_driver;
- int i;
- int ret;
- for (i = 0; i < TTY_MAX_COUNT; i++) {
- tty_driver = alloc_tty_driver(GDM_TTY_MINOR);
- if (!tty_driver)
- return -ENOMEM;
- tty_driver->owner = THIS_MODULE;
- tty_driver->driver_name = DRIVER_STRING[i];
- tty_driver->name = DEVICE_STRING[i];
- tty_driver->major = GDM_TTY_MAJOR;
- tty_driver->type = TTY_DRIVER_TYPE_SERIAL;
- tty_driver->subtype = SERIAL_TYPE_NORMAL;
- tty_driver->flags = TTY_DRIVER_REAL_RAW |
- TTY_DRIVER_DYNAMIC_DEV;
- tty_driver->init_termios = tty_std_termios;
- tty_driver->init_termios.c_cflag = B9600 | CS8 | HUPCL | CLOCAL;
- tty_driver->init_termios.c_lflag = ISIG | ICANON | IEXTEN;
- tty_set_operations(tty_driver, &gdm_tty_ops);
- ret = tty_register_driver(tty_driver);
- if (ret) {
- put_tty_driver(tty_driver);
- return ret;
- }
- gdm_driver[i] = tty_driver;
- }
- return ret;
- }
- void unregister_lte_tty_driver(void)
- {
- struct tty_driver *tty_driver;
- int i;
- for (i = 0; i < TTY_MAX_COUNT; i++) {
- tty_driver = gdm_driver[i];
- if (tty_driver) {
- tty_unregister_driver(tty_driver);
- put_tty_driver(tty_driver);
- }
- }
- }
|