tty/module.c
author Florian Pose <fp@igh-essen.com>
Tue, 01 Dec 2009 21:45:45 +0100
changeset 1569 61f5f4c35883
parent 1568 d9bbbe1883ab
child 1570 7a2a58107dd8
permissions -rw-r--r--
Interface management.
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     1
/******************************************************************************
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     2
 *
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     3
 *  $Id$
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     4
 *
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     5
 *  Copyright (C) 2006-2008  Florian Pose, Ingenieurgemeinschaft IgH
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     6
 *
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     7
 *  This file is part of the IgH EtherCAT Master.
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     8
 *
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     9
 *  The IgH EtherCAT Master is free software; you can redistribute it and/or
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    10
 *  modify it under the terms of the GNU General Public License version 2, as
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    11
 *  published by the Free Software Foundation.
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    12
 *
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    13
 *  The IgH EtherCAT Master is distributed in the hope that it will be useful,
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    14
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    15
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    16
 *  Public License for more details.
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    17
 *
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    18
 *  You should have received a copy of the GNU General Public License along
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    19
 *  with the IgH EtherCAT Master; if not, write to the Free Software
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    20
 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    21
 *
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    22
 *  ---
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    23
 *
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    24
 *  The license mentioned above concerns the source code only. Using the
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    25
 *  EtherCAT technology and brand is only permitted in compliance with the
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    26
 *  industrial property and similar rights of Beckhoff Automation GmbH.
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    27
 *
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    28
 *****************************************************************************/
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    29
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    30
/** \file
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    31
 * EtherCAT tty driver module.
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    32
 */
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    33
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    34
/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    35
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    36
#include <linux/module.h>
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    37
#include <linux/err.h>
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    38
#include <linux/tty.h>
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    39
#include <linux/tty_driver.h>
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    40
#include <linux/termios.h>
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    41
#include <linux/semaphore.h>
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    42
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    43
#include "../master/globals.h"
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    44
#include "../include/ectty.h"
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    45
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    46
/*****************************************************************************/
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    47
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    48
#define EC_TTY_MAX_DEVICES 10
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    49
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    50
/*****************************************************************************/
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    51
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    52
char *ec_master_version_str = EC_MASTER_VERSION; /**< Version string. */
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    53
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    54
static struct tty_driver *tty_driver = NULL;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    55
ec_tty_t *ttys[EC_TTY_MAX_DEVICES];
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    56
struct semaphore tty_sem;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    57
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    58
/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    59
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    60
/** \cond */
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    61
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    62
MODULE_AUTHOR("Florian Pose <fp@igh-essen.com>");
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    63
MODULE_DESCRIPTION("EtherCAT TTY driver module");
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    64
MODULE_LICENSE("GPL");
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    65
MODULE_VERSION(EC_MASTER_VERSION);
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    66
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    67
unsigned int debug_level = 0;
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    68
module_param_named(debug_level, debug_level, uint, S_IRUGO);
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    69
MODULE_PARM_DESC(debug_level, "Debug level");
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    70
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    71
/** \endcond */
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    72
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    73
static int ec_tty_open(struct tty_struct *, struct file *);
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    74
static void ec_tty_close(struct tty_struct *, struct file *);
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    75
static int ec_tty_write(struct tty_struct *, const unsigned char *, int);
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    76
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    77
static const struct tty_operations ec_tty_ops = {
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    78
    .open = ec_tty_open,
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    79
    .close = ec_tty_close,
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    80
    .write = ec_tty_write,
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    81
};
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    82
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    83
static struct ktermios ec_tty_std_termios = {
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    84
    .c_iflag = ICRNL | IXON,
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    85
    .c_oflag = OPOST | ONLCR,
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    86
    .c_cflag = B38400 | CS8 | CREAD | HUPCL,
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    87
    .c_lflag = ISIG | ICANON | ECHO | ECHOE | ECHOK | ECHOCTL | ECHOKE | IEXTEN,
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    88
    .c_cc = INIT_C_CC,
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    89
};
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    90
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    91
struct ec_tty {
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    92
    int minor;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    93
    struct device *dev;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    94
};
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    95
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    96
/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    97
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    98
/** Module initialization.
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    99
 *
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   100
 * \return 0 on success, else < 0
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   101
 */
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   102
int __init ec_tty_init_module(void)
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   103
{
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   104
    int i, ret = 0;
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   105
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   106
    EC_INFO("TTY driver %s\n", EC_MASTER_VERSION);
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   107
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   108
    init_MUTEX(&tty_sem);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   109
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   110
    for (i = 0; i < EC_TTY_MAX_DEVICES; i++) {
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   111
        ttys[i] = NULL;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   112
    }
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   113
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   114
    tty_driver = alloc_tty_driver(EC_TTY_MAX_DEVICES);
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   115
    if (!tty_driver) {
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   116
        EC_ERR("Failed to allocate tty driver.\n");
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   117
        ret = -ENOMEM;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   118
        goto out_return;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   119
    }
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   120
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   121
    tty_driver->owner = THIS_MODULE;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   122
    tty_driver->driver_name = "EtherCAT TTY";
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   123
    tty_driver->name = "ttyEC";
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   124
    tty_driver->major = 0;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   125
    tty_driver->minor_start = 0;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   126
    tty_driver->type = TTY_DRIVER_TYPE_SERIAL;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   127
    tty_driver->subtype = SERIAL_TYPE_NORMAL;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   128
    tty_driver->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   129
    tty_driver->init_termios = ec_tty_std_termios;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   130
    tty_driver->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   131
    tty_set_operations(tty_driver, &ec_tty_ops);
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   132
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   133
    ret = tty_register_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   134
    if (ret) {
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   135
        EC_ERR("Failed to register tty driver.\n");
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   136
        goto out_put;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   137
    }
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   138
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   139
    return ret;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   140
        
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   141
out_put:
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   142
    put_tty_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   143
out_return:
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   144
    return ret;
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   145
}
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   146
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   147
/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   148
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   149
/** Module cleanup.
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   150
 *
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   151
 * Clears all master instances.
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   152
 */
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   153
void __exit ec_tty_cleanup_module(void)
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   154
{
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   155
    tty_unregister_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   156
    put_tty_driver(tty_driver);
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   157
    EC_INFO("TTY module cleaned up.\n");
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   158
}
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   159
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   160
/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   161
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   162
int ec_tty_init(ec_tty_t *tty, int minor)
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   163
{
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   164
    tty->minor = minor;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   165
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   166
    tty->dev = tty_register_device(tty_driver, tty->minor, NULL);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   167
    if (IS_ERR(tty->dev)) {
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   168
        EC_ERR("Failed to register tty device.\n");
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   169
        return PTR_ERR(tty->dev);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   170
    }
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   171
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   172
    return 0;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   173
}
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   174
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   175
/*****************************************************************************/
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   176
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   177
void ec_tty_clear(ec_tty_t *tty)
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   178
{
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   179
    tty_unregister_device(tty_driver, tty->minor);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   180
}
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   181
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   182
/******************************************************************************
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   183
 * Device callbacks
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   184
 *****************************************************************************/
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   185
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   186
static int ec_tty_open(struct tty_struct *tty, struct file *file)
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   187
{
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   188
    return -EBUSY;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   189
}
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   190
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   191
/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   192
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   193
static void ec_tty_close(struct tty_struct *tty, struct file *file)
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   194
{
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   195
    return;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   196
}
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   197
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   198
/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   199
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   200
static int ec_tty_write(
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   201
        struct tty_struct *tty,
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   202
        const unsigned char *buffer,
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   203
        int count
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   204
        )
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   205
{
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   206
    return -EIO;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   207
}
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   208
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   209
/******************************************************************************
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   210
 * Public functions and methods
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   211
 *****************************************************************************/
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   212
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   213
ec_tty_t *ectty_create(void)
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   214
{
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   215
    ec_tty_t *tty;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   216
    int minor, ret;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   217
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   218
    if (down_interruptible(&tty_sem)) {
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   219
        return ERR_PTR(-EINTR);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   220
    }
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   221
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   222
    for (minor = 0; minor < EC_TTY_MAX_DEVICES; minor++) {
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   223
        if (!ttys[minor]) {
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   224
            tty = kmalloc(sizeof(ec_tty_t), GFP_KERNEL);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   225
            if (!tty) {
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   226
                up(&tty_sem);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   227
                EC_ERR("Failed to allocate memory for tty device.\n");
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   228
                return ERR_PTR(-ENOMEM);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   229
            }
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   230
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   231
            ret = ec_tty_init(tty, minor);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   232
            if (ret) {
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   233
                up(&tty_sem);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   234
                kfree(tty);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   235
                return ERR_PTR(ret);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   236
            }
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   237
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   238
            ttys[minor] = tty;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   239
            up(&tty_sem);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   240
            return tty;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   241
        }
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   242
    }
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   243
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   244
    up(&tty_sem);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   245
    return ERR_PTR(-EBUSY);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   246
}
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   247
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   248
/*****************************************************************************/
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   249
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   250
void ectty_free(ec_tty_t *tty)
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   251
{
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   252
    int minor = tty->minor;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   253
    ec_tty_clear(tty);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   254
    ttys[minor] = NULL;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   255
    kfree(tty);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   256
}
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   257
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   258
/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   259
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   260
/** \cond */
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   261
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   262
module_init(ec_tty_init_module);
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   263
module_exit(ec_tty_cleanup_module);
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   264
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   265
EXPORT_SYMBOL(ectty_create);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   266
EXPORT_SYMBOL(ectty_free);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   267
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   268
/** \endcond */
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   269
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   270
/*****************************************************************************/