etherlabmaster: tty/module.c@94dbb44884ec (annotated)

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>
1595 8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	43	#include <linux/version.h>
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	44	#include <linux/serial.h>
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	45	#include <linux/uaccess.h>
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	46
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	47	#include "../master/globals.h"
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	48	#include "../include/ectty.h"
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	49
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	50	/*****************************************************************************/
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	51
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	52	#define PFX "ec_tty: "
7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	53
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	54	#define EC_TTY_MAX_DEVICES 10
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	55	#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	56	#define EC_TTY_RX_BUFFER_SIZE 100
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	57
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	58	#define EC_TTY_DEBUG 0
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	59
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	60	/*****************************************************************************/
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	61
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	62	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	63	unsigned int debug_level = 0;
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	64
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	65	static struct tty_driver *tty_driver = NULL;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	66	ec_tty_t *ttys[EC_TTY_MAX_DEVICES];
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	67	struct semaphore tty_sem;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	68
1565 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
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	71	/** \cond */
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	72
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	73	MODULE_AUTHOR("Florian Pose <fp@igh-essen.com>");
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	74	MODULE_DESCRIPTION("EtherCAT TTY driver module");
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	75	MODULE_LICENSE("GPL");
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	76	MODULE_VERSION(EC_MASTER_VERSION);
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	77
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	78	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	79	MODULE_PARM_DESC(debug_level, "Debug level");
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	80
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	81	/** \endcond */
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	82
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	83	/** Standard termios for ec_tty devices.
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	84	*
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	85	* Simplest possible configuration, as you would expect.
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	86	*/
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	87	static struct ktermios ec_tty_std_termios = {
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	88	.c_iflag = 0,
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	89	.c_oflag = 0,
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	90	.c_cflag = B9600 \| CS8 \| CREAD,
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	91	.c_lflag = 0,
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	92	.c_cc = INIT_C_CC,
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	93	};
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	94
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	95	struct ec_tty {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	96	int minor;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	97	struct device *dev;
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	98
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	99	uint8_t tx_buffer[EC_TTY_TX_BUFFER_SIZE];
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	100	unsigned int tx_read_idx;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	101	unsigned int tx_write_idx;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	102	unsigned int wakeup;
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	103
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	104	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	105	unsigned int rx_read_idx;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	106	unsigned int rx_write_idx;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	107
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	108	struct timer_list timer;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	109	struct tty_struct *tty;
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	110	};
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	111
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	112	static const struct tty_operations ec_tty_ops; // see below
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	113
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	114	/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	115
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	116	/** Module initialization.
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	117	*
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	118	* \return 0 on success, else < 0
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	119	*/
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	120	int __init ec_tty_init_module(void)
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	121	{
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	122	int i, ret = 0;
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	123
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	124	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	125
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	126	init_MUTEX(&tty_sem);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	127
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	128	for (i = 0; i < EC_TTY_MAX_DEVICES; i++) {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	129	ttys[i] = NULL;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	130	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	131
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	132	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	133	if (!tty_driver) {
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	134	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	135	ret = -ENOMEM;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	136	goto out_return;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	137	}
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	138
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	139	tty_driver->owner = THIS_MODULE;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	140	tty_driver->driver_name = "EtherCAT TTY";
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	141	tty_driver->name = "ttyEC";
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	142	tty_driver->major = 0;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	143	tty_driver->minor_start = 0;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	144	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	145	tty_driver->subtype = SERIAL_TYPE_NORMAL;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	146	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	147	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	148	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	149
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	150	ret = tty_register_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	151	if (ret) {
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	152	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	153	goto out_put;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	154	}
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	155
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	156	return ret;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	157
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	158	out_put:
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	159	put_tty_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	160	out_return:
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	161	return ret;
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	162	}
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	/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	165
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	166	/** Module cleanup.
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	167	*
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	168	* Clears all master instances.
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	void __exit ec_tty_cleanup_module(void)
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	171	{
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	172	tty_unregister_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	173	put_tty_driver(tty_driver);
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	174	printk(KERN_INFO PFX "Module unloading.\n");
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	175	}
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	176
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	177	/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	178
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	179	unsigned int ec_tty_tx_size(ec_tty_t *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	180	{
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	181	unsigned int ret;
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	if (tty->tx_write_idx >= tty->tx_read_idx) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	184	ret = tty->tx_write_idx - tty->tx_read_idx;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	185	} else {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	186	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	187	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	188
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	189	return ret;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	190	}
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	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	193
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	194	unsigned int ec_tty_tx_space(ec_tty_t *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	195	{
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	196	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	197	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	198
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	199	/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	200
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	201	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	202	{
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	203	unsigned int ret;
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	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	206	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	207	} else {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	208	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	209	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	210
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	211	return ret;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	212	}
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	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	217	{
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	218	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	219	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	220
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
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	223	void ec_tty_wakeup(unsigned long data)
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	224	{
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	225	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	226	size_t to_recv;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	227
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	228	/* 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	229	if (tty->wakeup) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	230	if (tty->tty) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	231	#if EC_TTY_DEBUG >= 1
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	232	printk(KERN_INFO PFX "Waking up.\n");
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	233	#endif
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	234	tty_wakeup(tty->tty);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	235	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	236	tty->wakeup = 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	237	}
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	/* Push received data into TTY core. */
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	240	to_recv = ec_tty_rx_size(tty);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	241	if (to_recv && tty->tty) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	242	unsigned char *cbuf;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	243	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	244
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	245	if (space < to_recv) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	246	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	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 (space < 0) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	251	to_recv = 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	252	} else {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	253	to_recv = space;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	254	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	255
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	256	if (to_recv) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	257	unsigned int i;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	258
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	259	#if EC_TTY_DEBUG >= 1
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	260	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	261	#endif
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	for (i = 0; i < to_recv; i++) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	264	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	265	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	266	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	267	tty_flip_buffer_push(tty->tty);
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	tty->timer.expires += 1;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	272	add_timer(&tty->timer);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	273	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	274
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	275	/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	276
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	277	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	278	{
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	279	tty->minor = minor;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	280	tty->tx_read_idx = 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	281	tty->tx_write_idx = 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	282	tty->wakeup = 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	283	tty->rx_read_idx = 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	284	tty->rx_write_idx = 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	285	init_timer(&tty->timer);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	286	tty->tty = NULL;
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->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	289	if (IS_ERR(tty->dev)) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	290	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	291	return PTR_ERR(tty->dev);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	292	}
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	tty->timer.function = ec_tty_wakeup;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	295	tty->timer.data = (unsigned long) tty;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	296	tty->timer.expires = jiffies + 10;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	297	add_timer(&tty->timer);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	298	return 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	299	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	300
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
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	303	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	304	{
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	305	del_timer_sync(&tty->timer);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	306	tty_unregister_device(tty_driver, tty->minor);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	307	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	308
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	309	/*****************************************************************************/
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	310
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	311	int ec_tty_get_serial_info(ec_tty_t tty, struct serial_struct data)
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	312	{
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	313	struct serial_struct tmp;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	314
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	315	if (!data)
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	316	return -EFAULT;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	317
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	318	memset(&tmp, 0, sizeof(tmp));
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	319
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	320	if (copy_to_user(data, &tmp, sizeof(*data))) {
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	321	return -EFAULT;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	322	}
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	323	return 0;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	324	}
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	325
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	326	/******************************************************************************
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	327	* Device callbacks
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	328	*****************************************************************************/
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	329
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	330	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	331	{
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	332	ec_tty_t *t;
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	333	int line = tty->index;
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	334
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	335	#if EC_TTY_DEBUG >= 1
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	336	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	337	#endif
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	338
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	339	if (line < 0 \|\| line >= EC_TTY_MAX_DEVICES) {
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	340	return -ENXIO;
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	341	}
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	342
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	343	t = ttys[line];
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	344	if (!t) {
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	345	return -ENXIO;
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	346	}
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	347
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	348	if (t->tty) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	349	return -EBUSY;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	350	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	351
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	352	t->tty = tty;
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	353	tty->driver_data = t;
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	354	return 0;
1568 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
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	357	/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	358
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	359	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	360	{
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	361	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	362
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	363	#if EC_TTY_DEBUG >= 1
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	364	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	365	#endif
1575 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	if (t->tty == tty) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	368	t->tty = NULL;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	369	}
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	370	}
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	371
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	372	/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	373
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	374	static int ec_tty_write(
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	375	struct tty_struct *tty,
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	376	const unsigned char *buffer,
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	377	int count
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	378	)
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	379	{
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	380	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	381	unsigned int data_size, i;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	382
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	383	#if EC_TTY_DEBUG >= 1
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	384	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	385	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	386
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	387	if (count <= 0) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	388	return 0;
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
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	391	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	392	for (i = 0; i < data_size; i++) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	393	t->tx_buffer[t->tx_write_idx] = buffer[i];
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	394	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	395	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	396
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	397	#if EC_TTY_DEBUG >= 1
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	398	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	399	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	400	return data_size;
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
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	403	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	404
1595 8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	405	#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 26)
8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	406	static int ec_tty_put_char(struct tty_struct *tty, unsigned char ch)
8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	407	#else
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	408	static void ec_tty_put_char(struct tty_struct *tty, unsigned char ch)
1595 8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	409	#endif
1575 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	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	412
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	413	#if EC_TTY_DEBUG >= 1
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	414	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	415	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	416
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	417	if (ec_tty_tx_space(t)) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	418	t->tx_buffer[t->tx_write_idx] = ch;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	419	t->tx_write_idx = (t->tx_write_idx + 1) % EC_TTY_TX_BUFFER_SIZE;
1595 8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	420	#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 26)
8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	421	return 1;
8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	422	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	423	} else {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	424	printk(KERN_WARNING PFX "%s(): Dropped a byte!\n", __func__);
1595 8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	425	#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 26)
8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	426	return 0;
8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 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	}
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	static int ec_tty_write_room(struct tty_struct *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	434	{
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	435	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	436	int ret = ec_tty_tx_space(t);
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	437
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	438	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	439	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	440	#endif
1575 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	return ret;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	443	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	444
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	445	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	446
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	447	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	448	{
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	449	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	450	int ret;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	451
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	452	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	453	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	454	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	455
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	456	ret = ec_tty_tx_size(t);
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	457
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	458	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	459	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	460	#endif
1575 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	return ret;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	463	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	464
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	465	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	466
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	467	static void ec_tty_flush_buffer(struct tty_struct *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	468	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	469	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	470	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	471	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	472	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	473
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	474	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	475
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	476	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	477	unsigned int cmd, unsigned long arg)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	478	{
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	479	ec_tty_t t = (ec_tty_t ) tty->driver_data;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	480	int ret = -ENOTTY;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	481
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	482	#if EC_TTY_DEBUG >= 2
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	483	printk(KERN_INFO PFX "%s(tty=%p, file=%p, cmd=%08x, arg=%08lx).\n",
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	484	__func__, tty, file, cmd, arg);
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	485	printk(KERN_INFO PFX "decoded: type=%02x nr=%u\n",
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	486	_IOC_TYPE(cmd), _IOC_NR(cmd));
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	487	#endif
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	488
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	489	switch (cmd) {
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	490	case TIOCGSERIAL:
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	491	if (access_ok(VERIFY_WRITE,
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	492	(void *) arg, sizeof(struct serial_struct))) {
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	493	ret = ec_tty_get_serial_info(t, (struct serial_struct *) arg);
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	494	} else {
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	495	ret = -EFAULT;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	496	}
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	497	break;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	498
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	499	case TIOCSSERIAL: // TODO
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	500	break;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	501
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	502	default:
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	503	#if EC_TTY_DEBUG >= 2
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	504	printk(KERN_INFO PFX "no ioctl()!\n");
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	505	#endif
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	506	ret = -ENOIOCTLCMD;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	507	break;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	508	}
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	509
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	510	return ret;
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	511	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	512
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	513	/*****************************************************************************/
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	static void ec_tty_set_termios(struct tty_struct *tty,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	516	struct ktermios *old_termios)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	517	{
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	518	//ec_tty_t t = (ec_tty_t ) tty->driver_data;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 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
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	521	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	522	#endif
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	523
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	524	if (tty->termios->c_cflag == old_termios->c_cflag)
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	525	return;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	526
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	527	#if EC_TTY_DEBUG >= 2
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	528	printk(KERN_INFO "cflag changed from %x to %x.\n",
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	529	old_termios->c_cflag, tty->termios->c_cflag);
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	530	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	531	}
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	static void ec_tty_stop(struct tty_struct *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	536	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	537	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	538	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	539	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	540	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	541
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	static void ec_tty_start(struct tty_struct *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	545	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	546	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	547	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	548	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	549	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	550
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	551	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	552
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	553	static void ec_tty_hangup(struct tty_struct *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	554	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	555	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	556	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	557	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	558	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	559
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	560	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	561
1595 8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	562	#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)
8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	563	static int ec_tty_break(struct tty_struct *tty, int break_state)
8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	564	#else
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	565	static void ec_tty_break(struct tty_struct *tty, int break_state)
1595 8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	566	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	567	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	568	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	569	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	570	#endif
1595 8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	571
8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	572	#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)
8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	573	return -EIO; // not implemented
8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	574	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	575	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	576
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	577	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	578
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	579	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	580	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	581	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	582	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	583	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	584	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	585
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	586	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	587
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	588	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	589	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	590	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	591	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	592	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	593	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	594
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	595	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	596
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	597	static const struct tty_operations ec_tty_ops = {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	598	.open = ec_tty_open,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	599	.close = ec_tty_close,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	600	.write = ec_tty_write,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	601	.put_char = ec_tty_put_char,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	602	.write_room = ec_tty_write_room,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	603	.chars_in_buffer = ec_tty_chars_in_buffer,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	604	.flush_buffer = ec_tty_flush_buffer,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	605	.ioctl = ec_tty_ioctl,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	606	.set_termios = ec_tty_set_termios,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	607	.stop = ec_tty_stop,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	608	.start = ec_tty_start,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	609	.hangup = ec_tty_hangup,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	610	.break_ctl = ec_tty_break,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	611	.send_xchar = ec_tty_send_xchar,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	612	.wait_until_sent = ec_tty_wait_until_sent,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	613	};
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	614
1569 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	* Public functions and methods
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	617	*****************************************************************************/
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	618
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	619	ec_tty_t *ectty_create(void)
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	ec_tty_t *tty;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	622	int minor, ret;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	623
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	624	if (down_interruptible(&tty_sem)) {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	625	return ERR_PTR(-EINTR);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	626	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	627
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	628	for (minor = 0; minor < EC_TTY_MAX_DEVICES; minor++) {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	629	if (!ttys[minor]) {
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	630	printk(KERN_INFO PFX "Creating TTY interface %i.\n", minor);
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	631
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	632	tty = kmalloc(sizeof(ec_tty_t), GFP_KERNEL);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	633	if (!tty) {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	634	up(&tty_sem);
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	635	printk(KERN_ERR PFX "Failed to allocate memory.\n");
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	636	return ERR_PTR(-ENOMEM);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	637	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	638
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	639	ret = ec_tty_init(tty, minor);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	640	if (ret) {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	641	up(&tty_sem);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	642	kfree(tty);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	643	return ERR_PTR(ret);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	644	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	645
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	646	ttys[minor] = tty;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	647	up(&tty_sem);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	648	return tty;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	649	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	650	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	651
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	652	up(&tty_sem);
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	653	printk(KERN_ERR PFX "No free interfaces avaliable.\n");
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	654	return ERR_PTR(-EBUSY);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	655	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	656
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	657	/*****************************************************************************/
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	658
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	659	void ectty_free(ec_tty_t *tty)
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	660	{
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	661	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	662
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	663	ec_tty_clear(tty);
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	664	ttys[tty->minor] = NULL;
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	665	kfree(tty);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	666	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	667
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	668	/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	669
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	670	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	671	{
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	672	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	673
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	674	if (data_size) {
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	675	#if EC_TTY_DEBUG >= 1
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	676	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	677	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	678	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	679
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	680	for (i = 0; i < data_size; i++) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	681	buffer[i] = tty->tx_buffer[tty->tx_read_idx];
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	682	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	683	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	684
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	685	if (data_size) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	686	tty->wakeup = 1;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	687	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	688
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	689	return data_size;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	690	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	691
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	692	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	693
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	694	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	695	{
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	696	size_t to_recv;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	697
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	698	if (size) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	699	unsigned int i;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	700
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	701	#if EC_TTY_DEBUG >= 1
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	702	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	703	#endif
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	704
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	705	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	706
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	707	if (to_recv < size) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	708	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	709	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	710
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	711	for (i = 0; i < size; i++) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	712	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	713	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	714	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	715	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	716	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	717
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	718	/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	719
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	720	/** \cond */
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	721
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	722	module_init(ec_tty_init_module);
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	723	module_exit(ec_tty_cleanup_module);
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	724
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	725	EXPORT_SYMBOL(ectty_create);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	726	EXPORT_SYMBOL(ectty_free);
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	727	EXPORT_SYMBOL(ectty_tx_data);
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	728	EXPORT_SYMBOL(ectty_rx_data);
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	729
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	730	/** \endcond */
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	731
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	732	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Thu, 21 Jan 2010 16:41:41 +0100
changeset 1778	94dbb44884ec
parent 1595	8d8657654921
child 1779	9fab229d6ca9
permissions	-rw-r--r--