tty/module.c
author Martin Troxler <ch1010277@ch10lt194>
Tue, 19 Jan 2010 19:31:55 +0100
changeset 1776 65786b1d3043
parent 1577 fa3f66b783c1
child 1595 8d8657654921
permissions -rw-r--r--
removed tabulators
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>
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
    40
#include <linux/tty_flip.h>
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    41
#include <linux/termios.h>
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
    42
#include <linux/timer.h>
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    43
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    44
#include "../master/globals.h"
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    45
#include "../include/ectty.h"
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
1570
7a2a58107dd8 Use own PFX for printk.
Florian Pose <fp@igh-essen.com>
parents: 1569
diff changeset
    49
#define PFX "ec_tty: "
7a2a58107dd8 Use own PFX for printk.
Florian Pose <fp@igh-essen.com>
parents: 1569
diff changeset
    50
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    51
#define EC_TTY_MAX_DEVICES 10
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
    52
#define EC_TTY_TX_BUFFER_SIZE 100
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
    53
#define EC_TTY_RX_BUFFER_SIZE 100
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
    54
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
    55
#define EC_TTY_DEBUG 0
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    56
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    57
/*****************************************************************************/
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    58
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    59
char *ec_master_version_str = EC_MASTER_VERSION; /**< Version string. */
1570
7a2a58107dd8 Use own PFX for printk.
Florian Pose <fp@igh-essen.com>
parents: 1569
diff changeset
    60
unsigned int debug_level = 0;
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    61
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    62
static struct tty_driver *tty_driver = NULL;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    63
ec_tty_t *ttys[EC_TTY_MAX_DEVICES];
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    64
struct semaphore tty_sem;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    65
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    66
/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    67
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    68
/** \cond */
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    69
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    70
MODULE_AUTHOR("Florian Pose <fp@igh-essen.com>");
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    71
MODULE_DESCRIPTION("EtherCAT TTY driver module");
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    72
MODULE_LICENSE("GPL");
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    73
MODULE_VERSION(EC_MASTER_VERSION);
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    74
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    75
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
    76
MODULE_PARM_DESC(debug_level, "Debug level");
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    77
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    78
/** \endcond */
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    79
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    80
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
    81
    .c_iflag = ICRNL | IXON,
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
    82
    .c_oflag = OPOST,
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    83
    .c_cflag = B38400 | CS8 | CREAD | HUPCL,
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    84
    .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
    85
    .c_cc = INIT_C_CC,
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    86
};
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
    87
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    88
struct ec_tty {
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    89
    int minor;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
    90
    struct device *dev;
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
    91
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
    92
    uint8_t tx_buffer[EC_TTY_TX_BUFFER_SIZE];
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
    93
    unsigned int tx_read_idx;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
    94
    unsigned int tx_write_idx;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
    95
    unsigned int wakeup;
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
    96
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
    97
    uint8_t rx_buffer[EC_TTY_RX_BUFFER_SIZE];
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
    98
    unsigned int rx_read_idx;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
    99
    unsigned int rx_write_idx;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   100
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   101
    struct timer_list timer;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   102
    struct tty_struct *tty;
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   103
};
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   104
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   105
static const struct tty_operations ec_tty_ops; // see below
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   106
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   107
/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   108
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   109
/** Module initialization.
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   110
 *
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   111
 * \return 0 on success, else < 0
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   112
 */
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   113
int __init ec_tty_init_module(void)
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   114
{
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   115
    int i, ret = 0;
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   116
1570
7a2a58107dd8 Use own PFX for printk.
Florian Pose <fp@igh-essen.com>
parents: 1569
diff changeset
   117
    printk(KERN_INFO PFX "TTY driver %s\n", EC_MASTER_VERSION);
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   118
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   119
    init_MUTEX(&tty_sem);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   120
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   121
    for (i = 0; i < EC_TTY_MAX_DEVICES; i++) {
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   122
        ttys[i] = NULL;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   123
    }
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   124
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   125
    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
   126
    if (!tty_driver) {
1570
7a2a58107dd8 Use own PFX for printk.
Florian Pose <fp@igh-essen.com>
parents: 1569
diff changeset
   127
        printk(KERN_ERR PFX "Failed to allocate tty driver.\n");
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   128
        ret = -ENOMEM;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   129
        goto out_return;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   130
    }
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   131
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   132
    tty_driver->owner = THIS_MODULE;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   133
    tty_driver->driver_name = "EtherCAT TTY";
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   134
    tty_driver->name = "ttyEC";
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   135
    tty_driver->major = 0;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   136
    tty_driver->minor_start = 0;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   137
    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
   138
    tty_driver->subtype = SERIAL_TYPE_NORMAL;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   139
    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
   140
    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
   141
    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
   142
    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
   143
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   144
    ret = tty_register_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   145
    if (ret) {
1570
7a2a58107dd8 Use own PFX for printk.
Florian Pose <fp@igh-essen.com>
parents: 1569
diff changeset
   146
        printk(KERN_ERR PFX "Failed to register tty driver.\n");
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   147
        goto out_put;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   148
    }
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   149
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   150
    return ret;
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   151
        
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   152
out_put:
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   153
    put_tty_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   154
out_return:
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   155
    return ret;
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   156
}
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   157
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
/** Module cleanup.
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   161
 *
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   162
 * Clears all master instances.
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   163
 */
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   164
void __exit ec_tty_cleanup_module(void)
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   165
{
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   166
    tty_unregister_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   167
    put_tty_driver(tty_driver);
1570
7a2a58107dd8 Use own PFX for printk.
Florian Pose <fp@igh-essen.com>
parents: 1569
diff changeset
   168
    printk(KERN_INFO PFX "Module unloading.\n");
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   169
}
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   170
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   171
/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   172
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   173
unsigned int ec_tty_tx_size(ec_tty_t *tty)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   174
{
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   175
    unsigned int ret;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   176
    
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   177
    if (tty->tx_write_idx >= tty->tx_read_idx) {
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   178
        ret = tty->tx_write_idx - tty->tx_read_idx;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   179
    } else {
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   180
        ret = EC_TTY_TX_BUFFER_SIZE + tty->tx_write_idx - tty->tx_read_idx;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   181
    }
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   182
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   183
    return ret;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   184
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   185
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   186
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   187
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   188
unsigned int ec_tty_tx_space(ec_tty_t *tty)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   189
{
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   190
    return EC_TTY_TX_BUFFER_SIZE - 1 - ec_tty_tx_size(tty);
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   191
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   192
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   193
/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   194
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   195
unsigned int ec_tty_rx_size(ec_tty_t *tty)
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   196
{
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   197
    unsigned int ret;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   198
    
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   199
    if (tty->rx_write_idx >= tty->rx_read_idx) {
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   200
        ret = tty->rx_write_idx - tty->rx_read_idx;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   201
    } else {
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   202
        ret = EC_TTY_RX_BUFFER_SIZE + tty->rx_write_idx - tty->rx_read_idx;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   203
    }
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   204
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   205
    return ret;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   206
}
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   207
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   208
/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   209
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   210
unsigned int ec_tty_rx_space(ec_tty_t *tty)
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   211
{
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   212
    return EC_TTY_RX_BUFFER_SIZE - 1 - ec_tty_rx_size(tty);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   213
}
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   214
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   215
/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   216
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   217
void ec_tty_wakeup(unsigned long data)
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   218
{
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   219
    ec_tty_t *tty = (ec_tty_t *) data;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   220
    size_t to_recv;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   221
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   222
    /* Wake up any process waiting to send data */
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   223
    if (tty->wakeup) {
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   224
        if (tty->tty) {
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   225
#if EC_TTY_DEBUG >= 1
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   226
            printk(KERN_INFO PFX "Waking up.\n");
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   227
#endif
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   228
            tty_wakeup(tty->tty);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   229
        }
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   230
        tty->wakeup = 0;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   231
    }
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   232
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   233
    /* Push received data into TTY core. */
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   234
    to_recv = ec_tty_rx_size(tty);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   235
    if (to_recv && tty->tty) {
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   236
        unsigned char *cbuf;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   237
        int space = tty_prepare_flip_string(tty->tty, &cbuf, to_recv);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   238
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   239
		if (space < to_recv) {
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   240
			printk(KERN_WARNING PFX "Insufficient space to_recv=%d space=%d\n",
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   241
                    to_recv, space);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   242
		}
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   243
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   244
        if (space < 0) {
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   245
            to_recv = 0;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   246
        } else {
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   247
            to_recv = space;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   248
        }
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   249
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   250
        if (to_recv) {
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   251
            unsigned int i;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   252
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   253
#if EC_TTY_DEBUG >= 1
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   254
            printk(KERN_INFO PFX "Pushing %u bytes to TTY core.\n", to_recv);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   255
#endif
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   256
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   257
            for (i = 0; i < to_recv; i++) {
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   258
                cbuf[i] = tty->rx_buffer[tty->rx_read_idx];
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   259
                tty->rx_read_idx = (tty->rx_read_idx + 1) % EC_TTY_RX_BUFFER_SIZE;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   260
            }
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   261
            tty_flip_buffer_push(tty->tty);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   262
        }
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   263
	}
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   264
    
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   265
    tty->timer.expires += 1;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   266
    add_timer(&tty->timer);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   267
}
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   268
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   269
/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   270
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   271
int ec_tty_init(ec_tty_t *tty, int minor)
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   272
{
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   273
    tty->minor = minor;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   274
    tty->tx_read_idx = 0;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   275
    tty->tx_write_idx = 0;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   276
    tty->wakeup = 0;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   277
    tty->rx_read_idx = 0;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   278
    tty->rx_write_idx = 0;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   279
    init_timer(&tty->timer);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   280
    tty->tty = NULL;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   281
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   282
    tty->dev = tty_register_device(tty_driver, tty->minor, NULL);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   283
    if (IS_ERR(tty->dev)) {
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   284
        printk(KERN_ERR PFX "Failed to register tty device.\n");
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   285
        return PTR_ERR(tty->dev);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   286
    }
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   287
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   288
    tty->timer.function = ec_tty_wakeup;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   289
    tty->timer.data = (unsigned long) tty;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   290
    tty->timer.expires = jiffies + 10;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   291
    add_timer(&tty->timer);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   292
    return 0;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   293
}
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   294
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   295
/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   296
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   297
void ec_tty_clear(ec_tty_t *tty)
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   298
{
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   299
    del_timer_sync(&tty->timer);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   300
    tty_unregister_device(tty_driver, tty->minor);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   301
}
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   302
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   303
/******************************************************************************
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   304
 * Device callbacks
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   305
 *****************************************************************************/
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   306
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   307
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
   308
{
1571
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   309
    ec_tty_t *t;
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   310
    int line = tty->index;
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   311
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   312
#if EC_TTY_DEBUG >= 1
1571
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   313
    printk(KERN_INFO PFX "Opening line %i.\n", line);
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   314
#endif
1571
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   315
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   316
	if (line < 0 || line >= EC_TTY_MAX_DEVICES) {
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   317
		return -ENXIO;
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   318
    }
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   319
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   320
    t = ttys[line];
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   321
    if (!t) {
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   322
        return -ENXIO;
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   323
    }
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   324
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   325
    if (t->tty) {
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   326
        return -EBUSY;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   327
    }
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   328
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   329
    t->tty = tty;
1571
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   330
    tty->driver_data = t;
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   331
    return 0;
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   332
}
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   333
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   334
/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   335
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   336
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
   337
{
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   338
    ec_tty_t *t = (ec_tty_t *) tty->driver_data;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   339
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   340
#if EC_TTY_DEBUG >= 1
1571
88167b8589ef TTY open and close.
Florian Pose <fp@igh-essen.com>
parents: 1570
diff changeset
   341
    printk(KERN_INFO PFX "Closing line %i.\n", tty->index);
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   342
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   343
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   344
    if (t->tty == tty) {
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   345
        t->tty = NULL;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   346
    }
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   347
}
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   348
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   349
/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   350
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   351
static int ec_tty_write(
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   352
        struct tty_struct *tty,
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   353
        const unsigned char *buffer,
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   354
        int count
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   355
        )
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   356
{
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   357
    ec_tty_t *t = (ec_tty_t *) tty->driver_data;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   358
    unsigned int data_size, i;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   359
    
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   360
#if EC_TTY_DEBUG >= 1
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   361
    printk(KERN_INFO PFX "%s(count=%i)\n", __func__, count);
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   362
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   363
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   364
    if (count <= 0) {
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   365
        return 0;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   366
    }
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   367
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   368
    data_size = min(ec_tty_tx_space(t), (unsigned int) count);
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   369
    for (i = 0; i < data_size; i++) {
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   370
        t->tx_buffer[t->tx_write_idx] = buffer[i];
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   371
        t->tx_write_idx = (t->tx_write_idx + 1) % EC_TTY_TX_BUFFER_SIZE;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   372
    }
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   373
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   374
#if EC_TTY_DEBUG >= 1
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   375
    printk(KERN_INFO PFX "%s(): %u bytes written.\n", __func__, data_size);
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   376
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   377
    return data_size;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   378
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   379
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   380
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   381
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   382
static void ec_tty_put_char(struct tty_struct *tty, unsigned char ch)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   383
{
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   384
    ec_tty_t *t = (ec_tty_t *) tty->driver_data;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   385
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   386
#if EC_TTY_DEBUG >= 1
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   387
    printk(KERN_INFO PFX "%s(): c=%02x.\n", __func__, (unsigned int) ch);
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   388
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   389
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   390
    if (ec_tty_tx_space(t)) {
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   391
        t->tx_buffer[t->tx_write_idx] = ch;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   392
        t->tx_write_idx = (t->tx_write_idx + 1) % EC_TTY_TX_BUFFER_SIZE;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   393
    } else {
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   394
        printk(KERN_WARNING PFX "%s(): Dropped a byte!\n", __func__);
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   395
    }
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   396
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   397
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   398
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   399
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   400
static int ec_tty_write_room(struct tty_struct *tty)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   401
{
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   402
    ec_tty_t *t = (ec_tty_t *) tty->driver_data;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   403
    int ret = ec_tty_tx_space(t);
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   404
    
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   405
#if EC_TTY_DEBUG >= 2
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   406
    printk(KERN_INFO PFX "%s() = %i.\n", __func__, ret);
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   407
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   408
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   409
    return ret;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   410
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   411
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   412
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   413
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   414
static int ec_tty_chars_in_buffer(struct tty_struct *tty)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   415
{
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   416
    ec_tty_t *t = (ec_tty_t *) tty->driver_data;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   417
    int ret;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   418
    
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   419
#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   420
    printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   421
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   422
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   423
    ret = ec_tty_tx_size(t);
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   424
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   425
#if EC_TTY_DEBUG >= 2
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   426
    printk(KERN_INFO PFX "%s() = %i.\n", __func__, ret);
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   427
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   428
    
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   429
    return ret;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   430
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   431
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   432
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   433
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   434
static void ec_tty_flush_buffer(struct tty_struct *tty)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   435
{
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   436
#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   437
    printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   438
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   439
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   440
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   441
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   442
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   443
static int ec_tty_ioctl(struct tty_struct *tty, struct file *file,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   444
		    unsigned int cmd, unsigned long arg)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   445
{
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   446
#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   447
    printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   448
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   449
    return -ENOTTY;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   450
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   451
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   452
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   453
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   454
static void ec_tty_throttle(struct tty_struct *tty)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   455
{
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   456
#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   457
    printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   458
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   459
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   460
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   461
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   462
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   463
static void ec_tty_unthrottle(struct tty_struct *tty)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   464
{
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   465
#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   466
    printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   467
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   468
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   469
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   470
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   471
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   472
static void ec_tty_set_termios(struct tty_struct *tty,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   473
			   struct ktermios *old_termios)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   474
{
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   475
#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   476
    printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   477
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   478
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   479
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   480
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   481
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   482
static void ec_tty_stop(struct tty_struct *tty)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   483
{
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   484
#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   485
    printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   486
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   487
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   488
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   489
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   490
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   491
static void ec_tty_start(struct tty_struct *tty)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   492
{
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   493
#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   494
    printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   495
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   496
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   497
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   498
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   499
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   500
static void ec_tty_hangup(struct tty_struct *tty)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   501
{
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   502
#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   503
    printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   504
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   505
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   506
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   507
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   508
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   509
static void ec_tty_break(struct tty_struct *tty, int break_state)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   510
{
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   511
#if EC_TTY_DEBUG >= 2
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   512
    printk(KERN_INFO PFX "%s(break_state = %i).\n", __func__, break_state);
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   513
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   514
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   515
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   516
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   517
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   518
static void ec_tty_send_xchar(struct tty_struct *tty, char ch)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   519
{
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   520
#if EC_TTY_DEBUG >= 2
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   521
    printk(KERN_INFO PFX "%s(ch=%02x).\n", __func__, (unsigned int) ch);
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   522
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   523
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   524
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   525
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   526
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   527
static void ec_tty_wait_until_sent(struct tty_struct *tty, int timeout)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   528
{
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   529
#if EC_TTY_DEBUG >= 2
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   530
    printk(KERN_INFO PFX "%s(timeout=%i).\n", __func__, timeout);
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   531
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   532
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   533
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   534
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   535
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   536
static int ec_tty_tiocmget(struct tty_struct *tty, struct file *file)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   537
{
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   538
#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   539
    printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   540
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   541
    return -EBUSY;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   542
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   543
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   544
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   545
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   546
static int ec_tty_tiocmset(struct tty_struct *tty, struct file *file,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   547
		    unsigned int set, unsigned int clear)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   548
{
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   549
#if EC_TTY_DEBUG >= 2
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   550
    printk(KERN_INFO PFX "%s(set=%u, clear=%u).\n", __func__, set, clear);
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   551
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   552
    return -EBUSY;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   553
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   554
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   555
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   556
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   557
static const struct tty_operations ec_tty_ops = {
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   558
    .open = ec_tty_open,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   559
    .close = ec_tty_close,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   560
    .write = ec_tty_write,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   561
	.put_char = ec_tty_put_char,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   562
	.write_room = ec_tty_write_room,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   563
	.chars_in_buffer = ec_tty_chars_in_buffer,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   564
	.flush_buffer = ec_tty_flush_buffer,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   565
	.ioctl = ec_tty_ioctl,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   566
	.throttle = ec_tty_throttle,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   567
	.unthrottle = ec_tty_unthrottle,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   568
	.set_termios = ec_tty_set_termios,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   569
	.stop = ec_tty_stop,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   570
	.start = ec_tty_start,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   571
	.hangup = ec_tty_hangup,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   572
	.break_ctl = ec_tty_break,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   573
	.send_xchar = ec_tty_send_xchar,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   574
	.wait_until_sent = ec_tty_wait_until_sent,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   575
	.tiocmget = ec_tty_tiocmget,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   576
	.tiocmset = ec_tty_tiocmset,
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   577
};
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   578
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   579
/******************************************************************************
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   580
 * Public functions and methods
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   581
 *****************************************************************************/
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   582
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   583
ec_tty_t *ectty_create(void)
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   584
{
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   585
    ec_tty_t *tty;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   586
    int minor, ret;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   587
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   588
    if (down_interruptible(&tty_sem)) {
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   589
        return ERR_PTR(-EINTR);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   590
    }
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   591
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   592
    for (minor = 0; minor < EC_TTY_MAX_DEVICES; minor++) {
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   593
        if (!ttys[minor]) {
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   594
            printk(KERN_INFO PFX "Creating TTY interface %i.\n", minor);
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   595
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   596
            tty = kmalloc(sizeof(ec_tty_t), GFP_KERNEL);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   597
            if (!tty) {
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   598
                up(&tty_sem);
1570
7a2a58107dd8 Use own PFX for printk.
Florian Pose <fp@igh-essen.com>
parents: 1569
diff changeset
   599
                printk(KERN_ERR PFX "Failed to allocate memory.\n");
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   600
                return ERR_PTR(-ENOMEM);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   601
            }
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   602
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   603
            ret = ec_tty_init(tty, minor);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   604
            if (ret) {
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   605
                up(&tty_sem);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   606
                kfree(tty);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   607
                return ERR_PTR(ret);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   608
            }
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   609
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   610
            ttys[minor] = tty;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   611
            up(&tty_sem);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   612
            return tty;
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   613
        }
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   614
    }
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   615
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   616
    up(&tty_sem);
1570
7a2a58107dd8 Use own PFX for printk.
Florian Pose <fp@igh-essen.com>
parents: 1569
diff changeset
   617
    printk(KERN_ERR PFX "No free interfaces avaliable.\n");
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   618
    return ERR_PTR(-EBUSY);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   619
}
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   620
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   621
/*****************************************************************************/
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   622
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   623
void ectty_free(ec_tty_t *tty)
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   624
{
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   625
    printk(KERN_INFO PFX "Freeing TTY interface %i.\n", tty->minor);
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   626
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   627
    ec_tty_clear(tty);
1570
7a2a58107dd8 Use own PFX for printk.
Florian Pose <fp@igh-essen.com>
parents: 1569
diff changeset
   628
    ttys[tty->minor] = NULL;
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   629
    kfree(tty);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   630
}
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   631
1568
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   632
/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device.
Florian Pose <fp@igh-essen.com>
parents: 1565
diff changeset
   633
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   634
unsigned int ectty_tx_data(ec_tty_t *tty, uint8_t *buffer, size_t size)
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   635
{
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   636
    unsigned int data_size = min(ec_tty_tx_size(tty), size), i;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   637
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   638
    if (data_size)  {
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   639
#if EC_TTY_DEBUG >= 1
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   640
        printk(KERN_INFO PFX "Fetching %u bytes to send.\n", data_size);
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   641
#endif
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   642
    }
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   643
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   644
    for (i = 0; i < data_size; i++) {
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   645
        buffer[i] = tty->tx_buffer[tty->tx_read_idx];
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   646
        tty->tx_read_idx = (tty->tx_read_idx + 1) % EC_TTY_TX_BUFFER_SIZE;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   647
    }
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   648
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   649
    if (data_size) {
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   650
        tty->wakeup = 1;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   651
    }
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   652
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   653
    return data_size;
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   654
}
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   655
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   656
/*****************************************************************************/
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   657
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   658
void ectty_rx_data(ec_tty_t *tty, const uint8_t *buffer, size_t size)
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   659
{
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   660
    size_t to_recv;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   661
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   662
    if (size)  {
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   663
        unsigned int i;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   664
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   665
#if EC_TTY_DEBUG >= 1
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   666
        printk(KERN_INFO PFX "Received %u bytes.\n", size);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   667
#endif
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   668
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   669
        to_recv = min(ec_tty_rx_space(tty), size);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   670
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   671
        if (to_recv < size) {
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   672
            printk(KERN_WARNING PFX "Dropping %u bytes.\n", size - to_recv);
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   673
        }
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   674
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   675
        for (i = 0; i < size; i++) {
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   676
            tty->rx_buffer[tty->rx_write_idx] = buffer[i];
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   677
            tty->rx_write_idx = (tty->rx_write_idx + 1) % EC_TTY_RX_BUFFER_SIZE;
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   678
        }
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   679
    }
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   680
}
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   681
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   682
/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   683
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   684
/** \cond */
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   685
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   686
module_init(ec_tty_init_module);
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   687
module_exit(ec_tty_cleanup_module);
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   688
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   689
EXPORT_SYMBOL(ectty_create);
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   690
EXPORT_SYMBOL(ectty_free);
1575
17598f2332b6 Send direction works!
Florian Pose <fp@igh-essen.com>
parents: 1572
diff changeset
   691
EXPORT_SYMBOL(ectty_tx_data);
1577
fa3f66b783c1 Implemented reading direction of tty driver.
Florian Pose <fp@igh-essen.com>
parents: 1575
diff changeset
   692
EXPORT_SYMBOL(ectty_rx_data);
1569
61f5f4c35883 Interface management.
Florian Pose <fp@igh-essen.com>
parents: 1568
diff changeset
   693
1565
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   694
/** \endcond */
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   695
8c526cfe1399 Base files for new TTY driver.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   696
/*****************************************************************************/