kernel/drivers/staging/gdm724x/gdm_tty.c

   1 /*
   2  * Copyright (c) 2012 GCT Semiconductor, Inc. All rights reserved.
   3  *
   4  * This software is licensed under the terms of the GNU General Public
   5  * License version 2, as published by the Free Software Foundation, and
   6  * may be copied, distributed, and modified under those terms.
   7  *
   8  * This program is distributed in the hope that it will be useful,
   9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11  * GNU General Public License for more details.
  12  */
  13
  14 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  15
  16 #include <linux/kernel.h>
  17 #include <linux/errno.h>
  18 #include <linux/tty.h>
  19 #include <linux/tty_driver.h>
  20 #include <linux/tty_flip.h>
  21 #include <linux/module.h>
  22 #include <linux/slab.h>
  23 #include <linux/usb/cdc.h>
  24 #include <linux/serial.h>
  25 #include "gdm_tty.h"
  26
  27 #define GDM_TTY_MAJOR 0
  28 #define GDM_TTY_MINOR 32
  29
  30 #define ACM_CTRL_DTR 0x01
  31 #define ACM_CTRL_RTS 0x02
  32 #define ACM_CTRL_DSR 0x02
  33 #define ACM_CTRL_RI  0x08
  34 #define ACM_CTRL_DCD 0x01
  35
  36 #define WRITE_SIZE 2048
  37
  38 #define MUX_TX_MAX_SIZE 2048
  39
  40 #define gdm_tty_send(n, d, l, i, c, b) (\
  41         n->tty_dev->send_func(n->tty_dev->priv_dev, d, l, i, c, b))
  42 #define gdm_tty_recv(n, c) (\
  43         n->tty_dev->recv_func(n->tty_dev->priv_dev, c))
  44 #define gdm_tty_send_control(n, r, v, d, l) (\
  45         n->tty_dev->send_control(n->tty_dev->priv_dev, r, v, d, l))
  46
  47 #define GDM_TTY_READY(gdm) (gdm && gdm->tty_dev && gdm->port.count)
  48
  49 static struct tty_driver *gdm_driver[TTY_MAX_COUNT];
  50 static struct gdm *gdm_table[TTY_MAX_COUNT][GDM_TTY_MINOR];
  51 static DEFINE_MUTEX(gdm_table_lock);
  52
  53 static char *DRIVER_STRING[TTY_MAX_COUNT] = {"GCTATC", "GCTDM"};
  54 static char *DEVICE_STRING[TTY_MAX_COUNT] = {"GCT-ATC", "GCT-DM"};
  55
  56 static void gdm_port_destruct(struct tty_port *port)
  57 {
  58         struct gdm *gdm = container_of(port, struct gdm, port);
  59
  60         mutex_lock(&gdm_table_lock);
  61         gdm_table[gdm->index][gdm->minor] = NULL;
  62         mutex_unlock(&gdm_table_lock);
  63
  64         kfree(gdm);
  65 }
  66
  67 static struct tty_port_operations gdm_port_ops = {
  68         .destruct = gdm_port_destruct,
  69 };
  70
  71 static int gdm_tty_install(struct tty_driver *driver, struct tty_struct *tty)
  72 {
  73         struct gdm *gdm = NULL;
  74         int ret;
  75         int i;
  76         int j;
  77
  78         j = GDM_TTY_MINOR;
  79         for (i = 0; i < TTY_MAX_COUNT; i++) {
  80                 if (!strcmp(tty->driver->driver_name, DRIVER_STRING[i])) {
  81                         j = tty->index;
  82                         break;
  83                 }
  84         }
  85
  86         if (j == GDM_TTY_MINOR)
  87                 return -ENODEV;
  88
  89         mutex_lock(&gdm_table_lock);
  90         gdm = gdm_table[i][j];
  91         if (gdm == NULL) {
  92                 mutex_unlock(&gdm_table_lock);
  93                 return -ENODEV;
  94         }
  95
  96         tty_port_get(&gdm->port);
  97
  98         ret = tty_standard_install(driver, tty);
  99         if (ret) {
 100                 tty_port_put(&gdm->port);
 101                 mutex_unlock(&gdm_table_lock);
 102                 return ret;
 103         }
 104
 105         tty->driver_data = gdm;
 106         mutex_unlock(&gdm_table_lock);
 107
 108         return 0;
 109 }
 110
 111 static int gdm_tty_open(struct tty_struct *tty, struct file *filp)
 112 {
 113         struct gdm *gdm = tty->driver_data;
 114
 115         return tty_port_open(&gdm->port, tty, filp);
 116 }
 117
 118 static void gdm_tty_cleanup(struct tty_struct *tty)
 119 {
 120         struct gdm *gdm = tty->driver_data;
 121
 122         tty_port_put(&gdm->port);
 123 }
 124
 125 static void gdm_tty_hangup(struct tty_struct *tty)
 126 {
 127         struct gdm *gdm = tty->driver_data;
 128
 129         tty_port_hangup(&gdm->port);
 130 }
 131
 132 static void gdm_tty_close(struct tty_struct *tty, struct file *filp)
 133 {
 134         struct gdm *gdm = tty->driver_data;
 135
 136         tty_port_close(&gdm->port, tty, filp);
 137 }
 138
 139 static int gdm_tty_recv_complete(void *data,
 140                                  int len,
 141                                  int index,
 142                                  struct tty_dev *tty_dev,
 143                                  int complete)
 144 {
 145         struct gdm *gdm = tty_dev->gdm[index];
 146
 147         if (!GDM_TTY_READY(gdm)) {
 148                 if (complete == RECV_PACKET_PROCESS_COMPLETE)
 149                         gdm_tty_recv(gdm, gdm_tty_recv_complete);
 150                 return TO_HOST_PORT_CLOSE;
 151         }
 152
 153         if (data && len) {
 154                 if (tty_buffer_request_room(&gdm->port, len) == len) {
 155                         tty_insert_flip_string(&gdm->port, data, len);
 156                         tty_flip_buffer_push(&gdm->port);
 157                 } else {
 158                         return TO_HOST_BUFFER_REQUEST_FAIL;
 159                 }
 160         }
 161
 162         if (complete == RECV_PACKET_PROCESS_COMPLETE)
 163                 gdm_tty_recv(gdm, gdm_tty_recv_complete);
 164
 165         return 0;
 166 }
 167
 168 static void gdm_tty_send_complete(void *arg)
 169 {
 170         struct gdm *gdm = (struct gdm *)arg;
 171
 172         if (!GDM_TTY_READY(gdm))
 173                 return;
 174
 175         tty_port_tty_wakeup(&gdm->port);
 176 }
 177
 178 static int gdm_tty_write(struct tty_struct *tty, const unsigned char *buf,
 179                          int len)
 180 {
 181         struct gdm *gdm = tty->driver_data;
 182         int remain = len;
 183         int sent_len = 0;
 184         int sending_len = 0;
 185
 186         if (!GDM_TTY_READY(gdm))
 187                 return -ENODEV;
 188
 189         if (!len)
 190                 return 0;
 191
 192         while (1) {
 193                 sending_len = remain > MUX_TX_MAX_SIZE ? MUX_TX_MAX_SIZE :
 194                                                          remain;
 195                 gdm_tty_send(gdm,
 196                              (void *)(buf+sent_len),
 197                              sending_len,
 198                              gdm->index,
 199                              gdm_tty_send_complete,
 200                              gdm
 201                             );
 202                 sent_len += sending_len;
 203                 remain -= sending_len;
 204                 if (remain <= 0)
 205                         break;
 206         }
 207
 208         return len;
 209 }
 210
 211 static int gdm_tty_write_room(struct tty_struct *tty)
 212 {
 213         struct gdm *gdm = tty->driver_data;
 214
 215         if (!GDM_TTY_READY(gdm))
 216                 return -ENODEV;
 217
 218         return WRITE_SIZE;
 219 }
 220
 221 int register_lte_tty_device(struct tty_dev *tty_dev, struct device *device)
 222 {
 223         struct gdm *gdm;
 224         int i;
 225         int j;
 226
 227         for (i = 0; i < TTY_MAX_COUNT; i++) {
 228
 229                 gdm = kmalloc(sizeof(struct gdm), GFP_KERNEL);
 230                 if (!gdm)
 231                         return -ENOMEM;
 232
 233                 mutex_lock(&gdm_table_lock);
 234                 for (j = 0; j < GDM_TTY_MINOR; j++) {
 235                         if (!gdm_table[i][j])
 236                                 break;
 237                 }
 238
 239                 if (j == GDM_TTY_MINOR) {
 240                         kfree(gdm);
 241                         mutex_unlock(&gdm_table_lock);
 242                         return -EINVAL;
 243                 }
 244
 245                 gdm_table[i][j] = gdm;
 246                 mutex_unlock(&gdm_table_lock);
 247
 248                 tty_dev->gdm[i] = gdm;
 249                 tty_port_init(&gdm->port);
 250
 251                 gdm->port.ops = &gdm_port_ops;
 252                 gdm->index = i;
 253                 gdm->minor = j;
 254                 gdm->tty_dev = tty_dev;
 255
 256                 tty_port_register_device(&gdm->port, gdm_driver[i],
 257                                          gdm->minor, device);
 258         }
 259
 260         for (i = 0; i < MAX_ISSUE_NUM; i++)
 261                 gdm_tty_recv(gdm, gdm_tty_recv_complete);
 262
 263         return 0;
 264 }
 265
 266 void unregister_lte_tty_device(struct tty_dev *tty_dev)
 267 {
 268         struct gdm *gdm;
 269         struct tty_struct *tty;
 270         int i;
 271
 272         for (i = 0; i < TTY_MAX_COUNT; i++) {
 273                 gdm = tty_dev->gdm[i];
 274                 if (!gdm)
 275                         continue;
 276
 277                 mutex_lock(&gdm_table_lock);
 278                 gdm_table[gdm->index][gdm->minor] = NULL;
 279                 mutex_unlock(&gdm_table_lock);
 280
 281                 tty = tty_port_tty_get(&gdm->port);
 282                 if (tty) {
 283                         tty_vhangup(tty);
 284                         tty_kref_put(tty);
 285                 }
 286
 287                 tty_unregister_device(gdm_driver[i], gdm->minor);
 288                 tty_port_put(&gdm->port);
 289         }
 290 }
 291
 292 static const struct tty_operations gdm_tty_ops = {
 293         .install =      gdm_tty_install,
 294         .open =         gdm_tty_open,
 295         .close =        gdm_tty_close,
 296         .cleanup =      gdm_tty_cleanup,
 297         .hangup =       gdm_tty_hangup,
 298         .write =        gdm_tty_write,
 299         .write_room =   gdm_tty_write_room,
 300 };
 301
 302 int register_lte_tty_driver(void)
 303 {
 304         struct tty_driver *tty_driver;
 305         int i;
 306         int ret;
 307
 308         for (i = 0; i < TTY_MAX_COUNT; i++) {
 309                 tty_driver = alloc_tty_driver(GDM_TTY_MINOR);
 310                 if (!tty_driver)
 311                         return -ENOMEM;
 312
 313                 tty_driver->owner = THIS_MODULE;
 314                 tty_driver->driver_name = DRIVER_STRING[i];
 315                 tty_driver->name = DEVICE_STRING[i];
 316                 tty_driver->major = GDM_TTY_MAJOR;
 317                 tty_driver->type = TTY_DRIVER_TYPE_SERIAL;
 318                 tty_driver->subtype = SERIAL_TYPE_NORMAL;
 319                 tty_driver->flags = TTY_DRIVER_REAL_RAW |
 320                                         TTY_DRIVER_DYNAMIC_DEV;
 321                 tty_driver->init_termios = tty_std_termios;
 322                 tty_driver->init_termios.c_cflag = B9600 | CS8 | HUPCL | CLOCAL;
 323                 tty_driver->init_termios.c_lflag = ISIG | ICANON | IEXTEN;
 324                 tty_set_operations(tty_driver, &gdm_tty_ops);
 325
 326                 ret = tty_register_driver(tty_driver);
 327                 if (ret) {
 328                         put_tty_driver(tty_driver);
 329                         return ret;
 330                 }
 331
 332                 gdm_driver[i] = tty_driver;
 333         }
 334
 335         return ret;
 336 }
 337
 338 void unregister_lte_tty_driver(void)
 339 {
 340         struct tty_driver *tty_driver;
 341         int i;
 342
 343         for (i = 0; i < TTY_MAX_COUNT; i++) {
 344                 tty_driver = gdm_driver[i];
 345                 if (tty_driver) {
 346                         tty_unregister_driver(tty_driver);
 347                         put_tty_driver(tty_driver);
 348                 }
 349         }
 350 }
 351