etherlabmaster: tty/module.c@428ef1e462e4 (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>
1975 8e173dddd183 Improved compiling on 2.6.34 (thanks to Malcolm Lewis). Florian Pose <fp@igh-essen.com> parents: 1908 diff changeset	46	#include <linux/slab.h>
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	47
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	48	#include "../master/globals.h"
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	49	#include "../include/ectty.h"
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	/*****************************************************************************/
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	52
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	53	#define PFX "ec_tty: "
7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	54
1789 058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	55	#define EC_TTY_MAX_DEVICES 32
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	56	#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	57	#define EC_TTY_RX_BUFFER_SIZE 100
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	58
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	59	#define EC_TTY_DEBUG 0
1569 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	/*****************************************************************************/
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	62
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	63	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	64	unsigned int debug_level = 0;
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	65
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	66	static struct tty_driver *tty_driver = NULL;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	67	ec_tty_t *ttys[EC_TTY_MAX_DEVICES];
2028 55854f070c4a use rt_mutex instead of semaphore for mutual exclusion (use --enable-mutex) Martin Troxler <ch1010277@ch10pc446> parents: 1975 diff changeset	68	struct ec_mutex_t tty_sem;
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	69
1786 7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	70	void ec_tty_wakeup(unsigned long);
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	71
1565 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
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	74	/** \cond */
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	75
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	76	MODULE_AUTHOR("Florian Pose <fp@igh-essen.com>");
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	77	MODULE_DESCRIPTION("EtherCAT TTY driver module");
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	78	MODULE_LICENSE("GPL");
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	79	MODULE_VERSION(EC_MASTER_VERSION);
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	80
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	81	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	82	MODULE_PARM_DESC(debug_level, "Debug level");
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	83
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	84	/** \endcond */
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	85
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	86	/** Standard termios for ec_tty devices.
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	87	*
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	88	* Simplest possible configuration, as you would expect.
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	89	*/
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	90	static struct ktermios ec_tty_std_termios = {
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	91	.c_iflag = 0,
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	92	.c_oflag = 0,
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	93	.c_cflag = B9600 \| CS8 \| CREAD,
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	94	.c_lflag = 0,
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	95	.c_cc = INIT_C_CC,
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	96	};
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	97
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	98	struct ec_tty {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	99	int minor;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	100	struct device *dev;
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	101
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	102	uint8_t tx_buffer[EC_TTY_TX_BUFFER_SIZE];
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	103	unsigned int tx_read_idx;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	104	unsigned int tx_write_idx;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	105	unsigned int wakeup;
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	106
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	107	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	108	unsigned int rx_read_idx;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	109	unsigned int rx_write_idx;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	110
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	111	struct timer_list timer;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	112	struct tty_struct *tty;
1797 5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	113	unsigned int open_count;
2028 55854f070c4a use rt_mutex instead of semaphore for mutual exclusion (use --enable-mutex) Martin Troxler <ch1010277@ch10pc446> parents: 1975 diff changeset	114	struct ec_mutex_t sem;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	115
1787 439f186185be Callback set via own structure. Florian Pose <fp@igh-essen.com> parents: 1786 diff changeset	116	ec_tty_operations_t ops;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	117	void *cb_data;
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	118	};
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	119
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	120	static const struct tty_operations ec_tty_ops; // see below
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	121
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	122	/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	123
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	124	/** Module initialization.
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	125	*
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	126	* \return 0 on success, else < 0
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	127	*/
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	128	int __init ec_tty_init_module(void)
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	129	{
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	130	int i, ret = 0;
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	131
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	132	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	133
2028 55854f070c4a use rt_mutex instead of semaphore for mutual exclusion (use --enable-mutex) Martin Troxler <ch1010277@ch10pc446> parents: 1975 diff changeset	134	ec_mutex_init(&tty_sem);
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	135
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	136	for (i = 0; i < EC_TTY_MAX_DEVICES; i++) {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	137	ttys[i] = NULL;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	138	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	139
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	140	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	141	if (!tty_driver) {
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	142	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	143	ret = -ENOMEM;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	144	goto out_return;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	145	}
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	146
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	147	tty_driver->owner = THIS_MODULE;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	148	tty_driver->driver_name = "EtherCAT TTY";
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	149	tty_driver->name = "ttyEC";
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	150	tty_driver->major = 0;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	151	tty_driver->minor_start = 0;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	152	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	153	tty_driver->subtype = SERIAL_TYPE_NORMAL;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	154	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	155	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	156	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	157
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	158	ret = tty_register_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	159	if (ret) {
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	160	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	161	goto out_put;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	162	}
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	163
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	164	return ret;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	165
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	166	out_put:
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	167	put_tty_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	168	out_return:
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	169	return ret;
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	170	}
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	171
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	172	/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	173
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	174	/** Module cleanup.
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	* Clears all master instances.
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	void __exit ec_tty_cleanup_module(void)
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	179	{
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	180	tty_unregister_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	181	put_tty_driver(tty_driver);
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	182	printk(KERN_INFO PFX "Module unloading.\n");
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	183	}
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	184
1786 7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	185	/******************************************************************************
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	186	* ec_tty_t methods.
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	187	*****************************************************************************/
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	188
1789 058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	189	int ec_tty_init(ec_tty_t *t, int minor,
1787 439f186185be Callback set via own structure. Florian Pose <fp@igh-essen.com> parents: 1786 diff changeset	190	const ec_tty_operations_t ops, void cb_data)
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	191	{
1789 058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	192	int ret;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	193	tcflag_t cflag;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	194	struct tty_struct *tty;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	195
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	196	t->minor = minor;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	197	t->tx_read_idx = 0;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	198	t->tx_write_idx = 0;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	199	t->wakeup = 0;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	200	t->rx_read_idx = 0;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	201	t->rx_write_idx = 0;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	202	init_timer(&t->timer);
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	203	t->tty = NULL;
1797 5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	204	t->open_count = 0;
2028 55854f070c4a use rt_mutex instead of semaphore for mutual exclusion (use --enable-mutex) Martin Troxler <ch1010277@ch10pc446> parents: 1975 diff changeset	205	ec_mutex_init(&t->sem);
1789 058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	206	t->ops = *ops;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	207	t->cb_data = cb_data;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	208
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	209	t->dev = tty_register_device(tty_driver, t->minor, NULL);
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	210	if (IS_ERR(t->dev)) {
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	211	printk(KERN_ERR PFX "Failed to register tty device.\n");
1789 058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	212	return PTR_ERR(t->dev);
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	213	}
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	214
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	215	// Tell the device-specific implementation about the initial cflags
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	216	tty = tty_driver->ttys[minor];
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	217
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	218	if (tty && tty->termios) { // already opened before
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	219	cflag = tty->termios->c_cflag;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	220	} else {
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	221	cflag = tty_driver->init_termios.c_cflag;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	222	}
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	223	ret = t->ops.cflag_changed(t->cb_data, cflag);
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	224	if (ret) {
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	225	printk(KERN_ERR PFX "ERROR: Initial cflag 0x%x not accepted.\n",
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	226	cflag);
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	227	tty_unregister_device(tty_driver, t->minor);
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	228	return ret;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	229	}
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	230
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	231	t->timer.function = ec_tty_wakeup;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	232	t->timer.data = (unsigned long) t;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	233	t->timer.expires = jiffies + 10;
058248c47ba0 Pass initial cflag to device-specific implementation in constructor. Florian Pose <fp@igh-essen.com> parents: 1787 diff changeset	234	add_timer(&t->timer);
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	235	return 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	236	}
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
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	240	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	241	{
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	242	del_timer_sync(&tty->timer);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	243	tty_unregister_device(tty_driver, tty->minor);
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
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	246	/*****************************************************************************/
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	247
1786 7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	248	unsigned int ec_tty_tx_size(ec_tty_t *tty)
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	249	{
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	250	unsigned int ret;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	251
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	252	if (tty->tx_write_idx >= tty->tx_read_idx) {
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	253	ret = tty->tx_write_idx - tty->tx_read_idx;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	254	} else {
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	255	ret = EC_TTY_TX_BUFFER_SIZE + tty->tx_write_idx - tty->tx_read_idx;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	256	}
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	257
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	258	return ret;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	259	}
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	260
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	261	/*****************************************************************************/
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	262
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	263	unsigned int ec_tty_tx_space(ec_tty_t *tty)
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	264	{
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	265	return EC_TTY_TX_BUFFER_SIZE - 1 - ec_tty_tx_size(tty);
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	266	}
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	267
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	268	/*****************************************************************************/
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	269
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	270	unsigned int ec_tty_rx_size(ec_tty_t *tty)
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	271	{
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	272	unsigned int ret;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	273
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	274	if (tty->rx_write_idx >= tty->rx_read_idx) {
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	275	ret = tty->rx_write_idx - tty->rx_read_idx;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	276	} else {
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	277	ret = EC_TTY_RX_BUFFER_SIZE + tty->rx_write_idx - tty->rx_read_idx;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	278	}
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	279
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	280	return ret;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	281	}
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	282
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	283	/*****************************************************************************/
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	284
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	285	unsigned int ec_tty_rx_space(ec_tty_t *tty)
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	286	{
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	287	return EC_TTY_RX_BUFFER_SIZE - 1 - ec_tty_rx_size(tty);
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	288	}
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	289
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	290	/*****************************************************************************/
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	291
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	292	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	293	{
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	294	struct serial_struct tmp;
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	295
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	296	if (!data)
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	297	return -EFAULT;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	298
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	299	memset(&tmp, 0, sizeof(tmp));
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	300
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	301	if (copy_to_user(data, &tmp, sizeof(*data))) {
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	302	return -EFAULT;
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	303	}
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	304	return 0;
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	305	}
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	306
1786 7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	307	/*****************************************************************************/
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	308
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	309	/** Timer function.
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	310	*/
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	311	void ec_tty_wakeup(unsigned long data)
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	312	{
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	313	ec_tty_t tty = (ec_tty_t ) data;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	314	size_t to_recv;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	315
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	316	/* Wake up any process waiting to send data */
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	317	if (tty->wakeup) {
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	318	if (tty->tty) {
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	319	#if EC_TTY_DEBUG >= 1
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	320	printk(KERN_INFO PFX "Waking up.\n");
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	321	#endif
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	322	tty_wakeup(tty->tty);
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	323	}
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	324	tty->wakeup = 0;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	325	}
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	326
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	327	/* Push received data into TTY core. */
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	328	to_recv = ec_tty_rx_size(tty);
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	329	if (to_recv && tty->tty) {
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	330	unsigned char *cbuf;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	331	int space = tty_prepare_flip_string(tty->tty, &cbuf, to_recv);
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	332
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	333	if (space < to_recv) {
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	334	printk(KERN_WARNING PFX "Insufficient space to_recv=%d space=%d\n",
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	335	to_recv, space);
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	336	}
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	337
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	338	if (space < 0) {
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	339	to_recv = 0;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	340	} else {
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	341	to_recv = space;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	342	}
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	343
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	344	if (to_recv) {
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	345	unsigned int i;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	346
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	347	#if EC_TTY_DEBUG >= 1
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	348	printk(KERN_INFO PFX "Pushing %u bytes to TTY core.\n", to_recv);
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	349	#endif
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	350
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	351	for (i = 0; i < to_recv; i++) {
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	352	cbuf[i] = tty->rx_buffer[tty->rx_read_idx];
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	353	tty->rx_read_idx =
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	354	(tty->rx_read_idx + 1) % EC_TTY_RX_BUFFER_SIZE;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	355	}
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	356	tty_flip_buffer_push(tty->tty);
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	357	}
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	358	}
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	359
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	360	tty->timer.expires += 1;
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	361	add_timer(&tty->timer);
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	362	}
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	363
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	364	/******************************************************************************
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	365	* Device callbacks
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	366	*****************************************************************************/
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	367
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	368	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	369	{
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	370	ec_tty_t *t;
1787 439f186185be Callback set via own structure. Florian Pose <fp@igh-essen.com> parents: 1786 diff changeset	371	int line = tty->index;
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	372
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	373	#if EC_TTY_DEBUG >= 1
1797 5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	374	printk(KERN_INFO PFX "%s(tty=%p, file=%p): Opening line %i.\n",
5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	375	__func__, tty, file, line);
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	376	#endif
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	377
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	378	if (line < 0 \|\| line >= EC_TTY_MAX_DEVICES) {
1797 5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	379	tty->driver_data = NULL;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	380	return -ENXIO;
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	381	}
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	382
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	383	t = ttys[line];
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	384	if (!t) {
1797 5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	385	tty->driver_data = NULL;
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	386	return -ENXIO;
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	387	}
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	388
1797 5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	389	if (!t->tty) {
5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	390	t->tty = tty;
5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	391	tty->driver_data = t;
5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	392	}
5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	393
2028 55854f070c4a use rt_mutex instead of semaphore for mutual exclusion (use --enable-mutex) Martin Troxler <ch1010277@ch10pc446> parents: 1975 diff changeset	394	ec_mutex_lock(&t->sem);
1797 5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	395	t->open_count++;
2028 55854f070c4a use rt_mutex instead of semaphore for mutual exclusion (use --enable-mutex) Martin Troxler <ch1010277@ch10pc446> parents: 1975 diff changeset	396	ec_mutex_unlock(&t->sem);
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	397	return 0;
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	398	}
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	399
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	400	/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	401
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	402	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	403	{
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	404	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	405
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	406	#if EC_TTY_DEBUG >= 1
1797 5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	407	printk(KERN_INFO PFX "%s(tty=%p, file=%p): Closing line %i.\n",
5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	408	__func__, tty, file, tty->index);
5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	409	#endif
5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	410
5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	411	if (t) {
2028 55854f070c4a use rt_mutex instead of semaphore for mutual exclusion (use --enable-mutex) Martin Troxler <ch1010277@ch10pc446> parents: 1975 diff changeset	412	ec_mutex_lock(&t->sem);
1797 5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	413	if (--t->open_count == 0) {
5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	414	t->tty = NULL;
5bf740cd1599 Allow multiple open() calls to tty devices. Florian Pose <fp@igh-essen.com> parents: 1796 diff changeset	415	}
2028 55854f070c4a use rt_mutex instead of semaphore for mutual exclusion (use --enable-mutex) Martin Troxler <ch1010277@ch10pc446> parents: 1975 diff changeset	416	ec_mutex_unlock(&t->sem);
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	417	}
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	418	}
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	419
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	420	/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	421
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	422	static int ec_tty_write(
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	423	struct tty_struct *tty,
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	424	const unsigned char *buffer,
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	425	int count
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	426	)
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	427	{
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	428	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	429	unsigned int data_size, i;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	430
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	431	#if EC_TTY_DEBUG >= 1
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	432	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	433	#endif
1575 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	if (count <= 0) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	436	return 0;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	437	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	438
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	439	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	440	for (i = 0; i < data_size; i++) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	441	t->tx_buffer[t->tx_write_idx] = buffer[i];
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	442	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	443	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	444
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	445	#if EC_TTY_DEBUG >= 1
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	446	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	447	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	448	return data_size;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	449	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	450
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	451	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	452
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	453	#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	454	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	455	#else
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	456	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	457	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	458	{
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	459	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	460
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	461	#if EC_TTY_DEBUG >= 1
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	462	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	463	#endif
1575 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	if (ec_tty_tx_space(t)) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	466	t->tx_buffer[t->tx_write_idx] = ch;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	467	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	468	#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	469	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	470	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	471	} else {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	472	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	473	#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	474	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	475	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	476	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	477	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	478
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	479	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	480
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	481	static int ec_tty_write_room(struct tty_struct *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	482	{
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	483	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	484	int ret = ec_tty_tx_space(t);
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	485
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	486	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	487	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	488	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	489
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	490	return ret;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	491	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	492
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	493	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	494
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	495	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	496	{
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	497	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	498	int ret;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	499
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	500	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	501	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	502	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	503
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	504	ret = ec_tty_tx_size(t);
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	505
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	506	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	507	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	508	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	509
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	510	return ret;
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_flush_buffer(struct tty_struct *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	516	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	517	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	518	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	519	#endif
1796 3bb9ca8b58f2 Minor change. Florian Pose <fp@igh-essen.com> parents: 1789 diff changeset	520
3bb9ca8b58f2 Minor change. Florian Pose <fp@igh-essen.com> parents: 1789 diff changeset	521	// FIXME empty ring buffer
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	522	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	523
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	524	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	525
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	526	static int ec_tty_ioctl(struct tty_struct tty, struct file file,
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	527	unsigned int cmd, unsigned long arg)
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	528	{
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	529	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	530	int ret = -ENOTTY;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	531
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	532	#if EC_TTY_DEBUG >= 2
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	533	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	534	__func__, tty, file, cmd, arg);
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	535	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	536	_IOC_TYPE(cmd), _IOC_NR(cmd));
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	537	#endif
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	538
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	539	switch (cmd) {
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	540	case TIOCGSERIAL:
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	541	if (access_ok(VERIFY_WRITE,
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	542	(void *) arg, sizeof(struct serial_struct))) {
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	543	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	544	} else {
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	545	ret = -EFAULT;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	546	}
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	547	break;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	548
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	549	default:
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	550	#if EC_TTY_DEBUG >= 2
1796 3bb9ca8b58f2 Minor change. Florian Pose <fp@igh-essen.com> parents: 1789 diff changeset	551	printk(KERN_INFO PFX "no ioctl() -> handled by tty core!\n");
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	552	#endif
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	553	ret = -ENOIOCTLCMD;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	554	break;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	555	}
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	556
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	557	return ret;
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
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	562	static void ec_tty_set_termios(struct tty_struct *tty,
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	563	struct ktermios *old_termios)
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	564	{
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	565	ec_tty_t t = (ec_tty_t ) tty->driver_data;
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	566	int ret;
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 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
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	569	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	570	#endif
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	571
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	572	if (tty->termios->c_cflag == old_termios->c_cflag)
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	573	return;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	574
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	575	#if EC_TTY_DEBUG >= 2
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	576	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	577	old_termios->c_cflag, tty->termios->c_cflag);
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	578	#endif
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	579
1787 439f186185be Callback set via own structure. Florian Pose <fp@igh-essen.com> parents: 1786 diff changeset	580	ret = t->ops.cflag_changed(t->cb_data, tty->termios->c_cflag);
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	581	if (ret) {
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	582	printk(KERN_ERR PFX "ERROR: cflag 0x%x not accepted.\n",
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	583	tty->termios->c_cflag);
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	584	tty->termios->c_cflag = old_termios->c_cflag;
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	585	}
1575 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	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	589
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	590	static void ec_tty_stop(struct tty_struct *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	591	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	592	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	593	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	594	#endif
1575 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	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	598
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	599	static void ec_tty_start(struct tty_struct *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	600	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	601	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	602	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	603	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	604	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	605
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	606	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	607
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	608	static void ec_tty_hangup(struct tty_struct *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	609	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	610	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	611	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	612	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	613	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	614
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	615	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	616
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	617	#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	618	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	619	#else
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	620	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	621	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	622	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	623	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	624	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	625	#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	626
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	627	#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	628	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	629	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	630	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	631
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	632	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	633
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	634	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	635	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	636	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	637	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	638	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	639	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	640
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	641	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	642
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	643	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	644	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	645	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	646	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	647	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	648	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	649
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	650	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	651
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	652	static const struct tty_operations ec_tty_ops = {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	653	.open = ec_tty_open,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	654	.close = ec_tty_close,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	655	.write = ec_tty_write,
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	656	.put_char = ec_tty_put_char,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	657	.write_room = ec_tty_write_room,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	658	.chars_in_buffer = ec_tty_chars_in_buffer,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	659	.flush_buffer = ec_tty_flush_buffer,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	660	.ioctl = ec_tty_ioctl,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	661	.set_termios = ec_tty_set_termios,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	662	.stop = ec_tty_stop,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	663	.start = ec_tty_start,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	664	.hangup = ec_tty_hangup,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	665	.break_ctl = ec_tty_break,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	666	.send_xchar = ec_tty_send_xchar,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	667	.wait_until_sent = ec_tty_wait_until_sent,
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	668	};
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	669
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	670	/******************************************************************************
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	671	* Public functions and methods
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	672	*****************************************************************************/
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	673
1787 439f186185be Callback set via own structure. Florian Pose <fp@igh-essen.com> parents: 1786 diff changeset	674	ec_tty_t ectty_create(const ec_tty_operations_t ops, void *cb_data)
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	675	{
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	676	ec_tty_t *tty;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	677	int minor, ret;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	678
2028 55854f070c4a use rt_mutex instead of semaphore for mutual exclusion (use --enable-mutex) Martin Troxler <ch1010277@ch10pc446> parents: 1975 diff changeset	679	if (ec_mutex_lock_interruptible(&tty_sem)) {
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	680	return ERR_PTR(-EINTR);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	681	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	682
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	683	for (minor = 0; minor < EC_TTY_MAX_DEVICES; minor++) {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	684	if (!ttys[minor]) {
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	685	printk(KERN_INFO PFX "Creating TTY interface %i.\n", minor);
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	686
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	687	tty = kmalloc(sizeof(ec_tty_t), GFP_KERNEL);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	688	if (!tty) {
2028 55854f070c4a use rt_mutex instead of semaphore for mutual exclusion (use --enable-mutex) Martin Troxler <ch1010277@ch10pc446> parents: 1975 diff changeset	689	ec_mutex_unlock(&tty_sem);
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	690	printk(KERN_ERR PFX "Failed to allocate memory.\n");
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	691	return ERR_PTR(-ENOMEM);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	692	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	693
1787 439f186185be Callback set via own structure. Florian Pose <fp@igh-essen.com> parents: 1786 diff changeset	694	ret = ec_tty_init(tty, minor, ops, cb_data);
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	695	if (ret) {
2028 55854f070c4a use rt_mutex instead of semaphore for mutual exclusion (use --enable-mutex) Martin Troxler <ch1010277@ch10pc446> parents: 1975 diff changeset	696	ec_mutex_unlock(&tty_sem);
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	697	kfree(tty);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	698	return ERR_PTR(ret);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	699	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	700
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	701	ttys[minor] = tty;
2028 55854f070c4a use rt_mutex instead of semaphore for mutual exclusion (use --enable-mutex) Martin Troxler <ch1010277@ch10pc446> parents: 1975 diff changeset	702	ec_mutex_unlock(&tty_sem);
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	703	return tty;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	704	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	705	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	706
2028 55854f070c4a use rt_mutex instead of semaphore for mutual exclusion (use --enable-mutex) Martin Troxler <ch1010277@ch10pc446> parents: 1975 diff changeset	707	ec_mutex_unlock(&tty_sem);
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	708	printk(KERN_ERR PFX "No free interfaces avaliable.\n");
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	709	return ERR_PTR(-EBUSY);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	710	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	711
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	712	/*****************************************************************************/
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	713
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	714	void ectty_free(ec_tty_t *tty)
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	715	{
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	716	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	717
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	718	ec_tty_clear(tty);
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	719	ttys[tty->minor] = NULL;
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	720	kfree(tty);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	721	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	722
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	723	/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	724
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	725	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	726	{
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	727	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	728
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	729	if (data_size) {
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	730	#if EC_TTY_DEBUG >= 1
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	731	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	732	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	733	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	734
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	735	for (i = 0; i < data_size; i++) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	736	buffer[i] = tty->tx_buffer[tty->tx_read_idx];
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	737	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	738	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	739
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	740	if (data_size) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	741	tty->wakeup = 1;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	742	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	743
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	744	return data_size;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	745	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	746
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	747	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	748
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	749	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	750	{
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	751	size_t to_recv;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	752
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	753	if (size) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	754	unsigned int i;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	755
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	756	#if EC_TTY_DEBUG >= 1
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	757	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	758	#endif
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	759
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	760	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	761
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	762	if (to_recv < size) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	763	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	764	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	765
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	766	for (i = 0; i < size; i++) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	767	tty->rx_buffer[tty->rx_write_idx] = buffer[i];
1786 7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	768	tty->rx_write_idx =
7198caede741 Sorted methods. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	769	(tty->rx_write_idx + 1) % EC_TTY_RX_BUFFER_SIZE;
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	770	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	771	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	772	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	773
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	774	/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	775
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	776	/** \cond */
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	777
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	778	module_init(ec_tty_init_module);
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	779	module_exit(ec_tty_cleanup_module);
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	780
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	781	EXPORT_SYMBOL(ectty_create);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	782	EXPORT_SYMBOL(ectty_free);
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	783	EXPORT_SYMBOL(ectty_tx_data);
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	784	EXPORT_SYMBOL(ectty_rx_data);
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	785
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	786	/** \endcond */
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	787
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	788	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Tue, 10 Apr 2012 19:09:51 +0200
changeset 2390	428ef1e462e4
parent 2028	55854f070c4a
child 2393	5d7d2722dfaa
permissions	-rw-r--r--