etherlabmaster: tty/module.c@bc2aff866a5b (annotated)

1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	1	/******************************************************************************
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	2	*
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	3	* $Id$
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	4	*
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	5	* Copyright (C) 2006-2008 Florian Pose, Ingenieurgemeinschaft IgH
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	6	*
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	7	* This file is part of the IgH EtherCAT Master.
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	8	*
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	9	* The IgH EtherCAT Master is free software; you can redistribute it and/or
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	10	* modify it under the terms of the GNU General Public License version 2, as
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	11	* published by the Free Software Foundation.
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	12	*
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	13	* The IgH EtherCAT Master is distributed in the hope that it will be useful,
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	16	* Public License for more details.
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	17	*
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	18	* You should have received a copy of the GNU General Public License along
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	19	* with the IgH EtherCAT Master; if not, write to the Free Software
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	20	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	21	*
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	22	* ---
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	23	*
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	24	* The license mentioned above concerns the source code only. Using the
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	25	* EtherCAT technology and brand is only permitted in compliance with the
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	26	* industrial property and similar rights of Beckhoff Automation GmbH.
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	27	*
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	28	*****************************************************************************/
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	29
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	30	/** \file
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	31	* EtherCAT tty driver module.
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	32	*/
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	33
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	34	/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	35
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	36	#include <linux/module.h>
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	37	#include <linux/err.h>
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	38	#include <linux/tty.h>
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	39	#include <linux/tty_driver.h>
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	40	#include <linux/tty_flip.h>
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	41	#include <linux/termios.h>
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	42	#include <linux/timer.h>
1595 8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	43	#include <linux/version.h>
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	44	#include <linux/serial.h>
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	45	#include <linux/uaccess.h>
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	46
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	47	#include "../master/globals.h"
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	48	#include "../include/ectty.h"
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	49
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	50	/*****************************************************************************/
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	51
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	52	#define PFX "ec_tty: "
7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	53
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	54	#define EC_TTY_MAX_DEVICES 10
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	55	#define EC_TTY_TX_BUFFER_SIZE 100
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	56	#define EC_TTY_RX_BUFFER_SIZE 100
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	57
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	58	#define EC_TTY_DEBUG 0
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	59
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	60	/*****************************************************************************/
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	61
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	62	char ec_master_version_str = EC_MASTER_VERSION; /< Version string. /
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	63	unsigned int debug_level = 0;
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	64
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	65	static struct tty_driver *tty_driver = NULL;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	66	ec_tty_t *ttys[EC_TTY_MAX_DEVICES];
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	67	struct semaphore tty_sem;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	68
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	69	/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	70
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	71	/** \cond */
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	72
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	73	MODULE_AUTHOR("Florian Pose <fp@igh-essen.com>");
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	74	MODULE_DESCRIPTION("EtherCAT TTY driver module");
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	75	MODULE_LICENSE("GPL");
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	76	MODULE_VERSION(EC_MASTER_VERSION);
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	77
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	78	module_param_named(debug_level, debug_level, uint, S_IRUGO);
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	79	MODULE_PARM_DESC(debug_level, "Debug level");
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	80
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	81	/** \endcond */
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	82
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	83	/** Standard termios for ec_tty devices.
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	84	*
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	85	* Simplest possible configuration, as you would expect.
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	86	*/
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	87	static struct ktermios ec_tty_std_termios = {
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	88	.c_iflag = 0,
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	89	.c_oflag = 0,
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	90	.c_cflag = B9600 \| CS8 \| CREAD,
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	91	.c_lflag = 0,
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	92	.c_cc = INIT_C_CC,
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	93	};
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	94
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	95	struct ec_tty {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	96	int minor;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	97	struct device *dev;
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	98
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	99	uint8_t tx_buffer[EC_TTY_TX_BUFFER_SIZE];
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	100	unsigned int tx_read_idx;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	101	unsigned int tx_write_idx;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	102	unsigned int wakeup;
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	103
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	104	uint8_t rx_buffer[EC_TTY_RX_BUFFER_SIZE];
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	105	unsigned int rx_read_idx;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	106	unsigned int rx_write_idx;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	107
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	108	struct timer_list timer;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	109	struct tty_struct *tty;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	110
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1781 diff changeset	111	int (cflag_cb)(void , tcflag_t);
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	112	void *cb_data;
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	113	};
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	114
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	115	static const struct tty_operations ec_tty_ops; // see below
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	116
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	117	/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	118
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	119	/** Module initialization.
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	120	*
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	121	* \return 0 on success, else < 0
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	int __init ec_tty_init_module(void)
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	124	{
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	125	int i, ret = 0;
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	126
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	127	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	128
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	129	init_MUTEX(&tty_sem);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	130
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	131	for (i = 0; i < EC_TTY_MAX_DEVICES; i++) {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	132	ttys[i] = NULL;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	133	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	134
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	135	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	136	if (!tty_driver) {
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	137	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	138	ret = -ENOMEM;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	139	goto out_return;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	140	}
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	141
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	142	tty_driver->owner = THIS_MODULE;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	143	tty_driver->driver_name = "EtherCAT TTY";
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	144	tty_driver->name = "ttyEC";
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	145	tty_driver->major = 0;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	146	tty_driver->minor_start = 0;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	147	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	148	tty_driver->subtype = SERIAL_TYPE_NORMAL;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	149	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	150	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	151	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	152
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	153	ret = tty_register_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	154	if (ret) {
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	155	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	156	goto out_put;
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
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	159	return ret;
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	160
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	161	out_put:
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	162	put_tty_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	163	out_return:
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	164	return ret;
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	165	}
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	166
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	167	/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	168
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	169	/** Module cleanup.
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	* Clears all master instances.
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	void __exit ec_tty_cleanup_module(void)
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	174	{
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	175	tty_unregister_driver(tty_driver);
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	176	put_tty_driver(tty_driver);
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	177	printk(KERN_INFO PFX "Module unloading.\n");
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	178	}
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	179
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	180	/*****************************************************************************/
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	181
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	182	unsigned int ec_tty_tx_size(ec_tty_t *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	183	{
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	184	unsigned int ret;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	185
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	186	if (tty->tx_write_idx >= tty->tx_read_idx) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	187	ret = tty->tx_write_idx - tty->tx_read_idx;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	188	} else {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	189	ret = EC_TTY_TX_BUFFER_SIZE + tty->tx_write_idx - tty->tx_read_idx;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	190	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	191
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	192	return ret;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	193	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	194
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	195	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	196
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	197	unsigned int ec_tty_tx_space(ec_tty_t *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	198	{
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	199	return EC_TTY_TX_BUFFER_SIZE - 1 - ec_tty_tx_size(tty);
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	200	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	201
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	202	/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	203
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	204	unsigned int ec_tty_rx_size(ec_tty_t *tty)
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	205	{
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	206	unsigned int ret;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	207
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	208	if (tty->rx_write_idx >= tty->rx_read_idx) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	209	ret = tty->rx_write_idx - tty->rx_read_idx;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	210	} else {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	211	ret = EC_TTY_RX_BUFFER_SIZE + tty->rx_write_idx - tty->rx_read_idx;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	212	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	213
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	214	return ret;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	215	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	216
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	217	/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	218
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	219	unsigned int ec_tty_rx_space(ec_tty_t *tty)
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	220	{
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	221	return EC_TTY_RX_BUFFER_SIZE - 1 - ec_tty_rx_size(tty);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	222	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	223
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	224	/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	225
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	226	void ec_tty_wakeup(unsigned long data)
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	227	{
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	228	ec_tty_t tty = (ec_tty_t ) data;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	229	size_t to_recv;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	230
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	231	/* Wake up any process waiting to send data */
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	232	if (tty->wakeup) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	233	if (tty->tty) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	234	#if EC_TTY_DEBUG >= 1
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	235	printk(KERN_INFO PFX "Waking up.\n");
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	236	#endif
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	237	tty_wakeup(tty->tty);
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	tty->wakeup = 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	240	}
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	/* Push received data into TTY core. */
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	243	to_recv = ec_tty_rx_size(tty);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	244	if (to_recv && tty->tty) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	245	unsigned char *cbuf;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	246	int space = tty_prepare_flip_string(tty->tty, &cbuf, to_recv);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	247
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	248	if (space < to_recv) {
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	249	printk(KERN_WARNING PFX "Insufficient space to_recv=%d space=%d\n",
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	250	to_recv, space);
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	251	}
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	252
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	253	if (space < 0) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	254	to_recv = 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	255	} else {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	256	to_recv = space;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	257	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	258
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	259	if (to_recv) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	260	unsigned int i;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	261
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	262	#if EC_TTY_DEBUG >= 1
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	263	printk(KERN_INFO PFX "Pushing %u bytes to TTY core.\n", to_recv);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	264	#endif
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	265
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	266	for (i = 0; i < to_recv; i++) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	267	cbuf[i] = tty->rx_buffer[tty->rx_read_idx];
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	268	tty->rx_read_idx = (tty->rx_read_idx + 1) % EC_TTY_RX_BUFFER_SIZE;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	269	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	270	tty_flip_buffer_push(tty->tty);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	271	}
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	272	}
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	273
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	274	tty->timer.expires += 1;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	275	add_timer(&tty->timer);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	276	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	277
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	278	/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	279
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	280	int ec_tty_init(ec_tty_t *tty, int minor,
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1781 diff changeset	281	int (cflag_cb)(void , tcflag_t), void *cb_data)
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	282	{
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	283	tty->minor = minor;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	284	tty->tx_read_idx = 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	285	tty->tx_write_idx = 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	286	tty->wakeup = 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	287	tty->rx_read_idx = 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	288	tty->rx_write_idx = 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	289	init_timer(&tty->timer);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	290	tty->tty = NULL;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	291	tty->cflag_cb = cflag_cb;
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	292	tty->cb_data = cb_data;
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	293
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	294	tty->dev = tty_register_device(tty_driver, tty->minor, NULL);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	295	if (IS_ERR(tty->dev)) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	296	printk(KERN_ERR PFX "Failed to register tty device.\n");
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	297	return PTR_ERR(tty->dev);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	298	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	299
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	300	tty->timer.function = ec_tty_wakeup;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	301	tty->timer.data = (unsigned long) tty;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	302	tty->timer.expires = jiffies + 10;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	303	add_timer(&tty->timer);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	304	return 0;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	305	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	306
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	307	/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	308
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	309	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	310	{
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	311	del_timer_sync(&tty->timer);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	312	tty_unregister_device(tty_driver, tty->minor);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	313	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	314
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	315	/*****************************************************************************/
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	316
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	317	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	318	{
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	319	struct serial_struct tmp;
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	320
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	321	if (!data)
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	322	return -EFAULT;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	323
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	324	memset(&tmp, 0, sizeof(tmp));
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	325
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	326	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	327	return -EFAULT;
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	328	}
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	329	return 0;
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	330	}
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	331
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	332	/******************************************************************************
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	333	* Device callbacks
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	334	*****************************************************************************/
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	335
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	336	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	337	{
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	338	ec_tty_t *t;
1781 e3346de75612 Request initial configuration on tty open. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	339	int line = tty->index, ret;
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	340
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	341	#if EC_TTY_DEBUG >= 1
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	342	printk(KERN_INFO PFX "Opening line %i.\n", line);
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	343	#endif
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	344
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	345	if (line < 0 \|\| line >= EC_TTY_MAX_DEVICES) {
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	346	return -ENXIO;
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	347	}
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	348
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	349	t = ttys[line];
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	350	if (!t) {
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	351	return -ENXIO;
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	352	}
88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	353
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	354	if (t->tty) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	355	return -EBUSY;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	356	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	357
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	358	t->tty = tty;
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	359	tty->driver_data = t;
1781 e3346de75612 Request initial configuration on tty open. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	360
e3346de75612 Request initial configuration on tty open. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	361	// request initial settings
e3346de75612 Request initial configuration on tty open. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	362	ret = t->cflag_cb(t->cb_data, t->tty->termios->c_cflag);
e3346de75612 Request initial configuration on tty open. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	363	if (ret) {
e3346de75612 Request initial configuration on tty open. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	364	printk(KERN_ERR PFX "Error: Device does not accept"
e3346de75612 Request initial configuration on tty open. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	365	" initial configuration!\n");
e3346de75612 Request initial configuration on tty open. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	366	return ret;
e3346de75612 Request initial configuration on tty open. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	367	}
e3346de75612 Request initial configuration on tty open. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	368
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	369	return 0;
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	370	}
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	371
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	372	/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	373
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	374	static 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	375	{
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	376	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	377
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	378	#if EC_TTY_DEBUG >= 1
1571 88167b8589ef TTY open and close. Florian Pose <fp@igh-essen.com> parents: 1570 diff changeset	379	printk(KERN_INFO PFX "Closing line %i.\n", tty->index);
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	380	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	381
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	382	if (t->tty == tty) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	383	t->tty = NULL;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	384	}
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	385	}
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	386
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	387	/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	388
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	389	static int ec_tty_write(
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	390	struct tty_struct *tty,
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	391	const unsigned char *buffer,
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	392	int count
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	393	)
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	394	{
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	395	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	396	unsigned int data_size, i;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	397
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	398	#if EC_TTY_DEBUG >= 1
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	399	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	400	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	401
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	402	if (count <= 0) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	403	return 0;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	404	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	405
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	406	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	407	for (i = 0; i < data_size; i++) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	408	t->tx_buffer[t->tx_write_idx] = buffer[i];
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	409	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	410	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	411
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	412	#if EC_TTY_DEBUG >= 1
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	413	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	414	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	415	return data_size;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	416	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	417
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	418	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	419
1595 8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	420	#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 26)
8d8657654921 Implemented tty put_char and break_ctl callbacks for kernels newer than 2.6.26 Florian Pose <fp@igh-essen.com> parents: 1577 diff changeset	421	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	422	#else
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	423	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	424	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	425	{
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	426	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	427
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	428	#if EC_TTY_DEBUG >= 1
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	429	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	430	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	431
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	432	if (ec_tty_tx_space(t)) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	433	t->tx_buffer[t->tx_write_idx] = ch;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	434	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	435	#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	436	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	437	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	438	} else {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	439	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	440	#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	441	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	442	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	443	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	444	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	445
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	446	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	447
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	448	static int ec_tty_write_room(struct tty_struct *tty)
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	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	451	int ret = ec_tty_tx_space(t);
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	452
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	453	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	454	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	455	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	456
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	457	return ret;
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
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	460	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	461
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	462	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	463	{
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	464	ec_tty_t t = (ec_tty_t ) tty->driver_data;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	465	int ret;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	466
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	467	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	468	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	469	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	470
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	471	ret = ec_tty_tx_size(t);
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	472
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	473	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	474	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	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	return ret;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	478	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	479
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	480	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	481
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	482	static void ec_tty_flush_buffer(struct tty_struct *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	483	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	484	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	485	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	486	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	487	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	488
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	489	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	490
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	491	static 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	492	unsigned int cmd, unsigned long arg)
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	493	{
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	494	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	495	int ret = -ENOTTY;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	496
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	497	#if EC_TTY_DEBUG >= 2
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	498	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	499	__func__, tty, file, cmd, arg);
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	500	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	501	_IOC_TYPE(cmd), _IOC_NR(cmd));
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	502	#endif
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	503
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	504	switch (cmd) {
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	505	case TIOCGSERIAL:
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	506	if (access_ok(VERIFY_WRITE,
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	507	(void *) arg, sizeof(struct serial_struct))) {
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	508	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	509	} else {
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	510	ret = -EFAULT;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	511	}
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	512	break;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	513
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	514	case TIOCSSERIAL: // TODO
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	515	break;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	516
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	517	default:
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	518	#if EC_TTY_DEBUG >= 2
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	519	printk(KERN_INFO PFX "no ioctl()!\n");
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	520	#endif
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	521	ret = -ENOIOCTLCMD;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	522	break;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	523	}
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	524
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	525	return ret;
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	526	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	527
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	528	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	529
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	530	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	531	struct ktermios *old_termios)
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	532	{
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	533	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	534	int ret;
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	535
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	536	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	537	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	538	#endif
1778 94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	539
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	540	if (tty->termios->c_cflag == old_termios->c_cflag)
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	541	return;
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	542
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	543	#if EC_TTY_DEBUG >= 2
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	544	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	545	old_termios->c_cflag, tty->termios->c_cflag);
94dbb44884ec Basic configuration for tty. Florian Pose <fp@igh-essen.com> parents: 1595 diff changeset	546	#endif
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	547
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	548	ret = t->cflag_cb(t->cb_data, tty->termios->c_cflag);
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	549	if (ret) {
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	550	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	551	tty->termios->c_cflag);
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	552	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	553	}
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	554	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	555
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	556	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	557
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	558	static void ec_tty_stop(struct tty_struct *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	559	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	560	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	561	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	562	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	563	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	564
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	565	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	566
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	567	static void ec_tty_start(struct tty_struct *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	568	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	569	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	570	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	571	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	572	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	573
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	574	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	575
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	576	static void ec_tty_hangup(struct tty_struct *tty)
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	577	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	578	#if EC_TTY_DEBUG >= 2
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	579	printk(KERN_INFO PFX "%s().\n", __func__);
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	580	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	581	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	582
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	583	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	584
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	585	#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	586	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	587	#else
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	588	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	589	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	590	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	591	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	592	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	593	#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	594
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	595	#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	596	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	597	#endif
1575 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
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	600	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	601
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	602	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	603	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	604	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	605	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	606	#endif
1575 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
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	609	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	610
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	611	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	612	{
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	613	#if EC_TTY_DEBUG >= 2
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	614	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	615	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	616	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	617
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	618	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	619
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	620	static const struct tty_operations ec_tty_ops = {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	621	.open = ec_tty_open,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	622	.close = ec_tty_close,
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	623	.write = ec_tty_write,
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	624	.put_char = ec_tty_put_char,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	625	.write_room = ec_tty_write_room,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	626	.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	627	.flush_buffer = ec_tty_flush_buffer,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	628	.ioctl = ec_tty_ioctl,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	629	.set_termios = ec_tty_set_termios,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	630	.stop = ec_tty_stop,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	631	.start = ec_tty_start,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	632	.hangup = ec_tty_hangup,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	633	.break_ctl = ec_tty_break,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	634	.send_xchar = ec_tty_send_xchar,
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	635	.wait_until_sent = ec_tty_wait_until_sent,
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	636	};
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	637
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	638	/******************************************************************************
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	639	* Public functions and methods
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	640	*****************************************************************************/
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	641
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1781 diff changeset	642	ec_tty_t ectty_create(int (cflag_cb)(void , tcflag_t), void cb_data)
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	643	{
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	644	ec_tty_t *tty;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	645	int minor, ret;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	646
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	647	if (down_interruptible(&tty_sem)) {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	648	return ERR_PTR(-EINTR);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	649	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	650
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	651	for (minor = 0; minor < EC_TTY_MAX_DEVICES; minor++) {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	652	if (!ttys[minor]) {
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	653	printk(KERN_INFO PFX "Creating TTY interface %i.\n", minor);
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	654
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	655	tty = kmalloc(sizeof(ec_tty_t), GFP_KERNEL);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	656	if (!tty) {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	657	up(&tty_sem);
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	658	printk(KERN_ERR PFX "Failed to allocate memory.\n");
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	659	return ERR_PTR(-ENOMEM);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	660	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	661
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1778 diff changeset	662	ret = ec_tty_init(tty, minor, cflag_cb, cb_data);
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	663	if (ret) {
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	664	up(&tty_sem);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	665	kfree(tty);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	666	return ERR_PTR(ret);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	667	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	668
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	669	ttys[minor] = tty;
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	670	up(&tty_sem);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	671	return tty;
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	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	674
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	675	up(&tty_sem);
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	676	printk(KERN_ERR PFX "No free interfaces avaliable.\n");
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	677	return ERR_PTR(-EBUSY);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	678	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	679
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	680	/*****************************************************************************/
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	void ectty_free(ec_tty_t *tty)
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	683	{
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	684	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	685
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	686	ec_tty_clear(tty);
1570 7a2a58107dd8 Use own PFX for printk. Florian Pose <fp@igh-essen.com> parents: 1569 diff changeset	687	ttys[tty->minor] = NULL;
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	688	kfree(tty);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	689	}
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	690
1568 d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	691	/*****************************************************************************/
d9bbbe1883ab Register a TTY driver with one device. Florian Pose <fp@igh-essen.com> parents: 1565 diff changeset	692
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	693	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	694	{
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	695	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	696
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	697	if (data_size) {
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	698	#if EC_TTY_DEBUG >= 1
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	699	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	700	#endif
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	701	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	702
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	703	for (i = 0; i < data_size; i++) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	704	buffer[i] = tty->tx_buffer[tty->tx_read_idx];
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	705	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	706	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	707
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	708	if (data_size) {
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	709	tty->wakeup = 1;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	710	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	711
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	712	return data_size;
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	713	}
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	714
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	715	/*****************************************************************************/
17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	716
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	717	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	718	{
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	719	size_t to_recv;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	720
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	721	if (size) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	722	unsigned int i;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	723
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	724	#if EC_TTY_DEBUG >= 1
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	725	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	726	#endif
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	727
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	728	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	729
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	730	if (to_recv < size) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	731	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	732	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	733
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	734	for (i = 0; i < size; i++) {
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	735	tty->rx_buffer[tty->rx_write_idx] = buffer[i];
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	736	tty->rx_write_idx = (tty->rx_write_idx + 1) % EC_TTY_RX_BUFFER_SIZE;
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	737	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	738	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	739	}
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	740
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	741	/*****************************************************************************/
fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	742
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	743	/** \cond */
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	744
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	745	module_init(ec_tty_init_module);
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	746	module_exit(ec_tty_cleanup_module);
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	747
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	748	EXPORT_SYMBOL(ectty_create);
61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	749	EXPORT_SYMBOL(ectty_free);
1575 17598f2332b6 Send direction works! Florian Pose <fp@igh-essen.com> parents: 1572 diff changeset	750	EXPORT_SYMBOL(ectty_tx_data);
1577 fa3f66b783c1 Implemented reading direction of tty driver. Florian Pose <fp@igh-essen.com> parents: 1575 diff changeset	751	EXPORT_SYMBOL(ectty_rx_data);
1569 61f5f4c35883 Interface management. Florian Pose <fp@igh-essen.com> parents: 1568 diff changeset	752
1565 8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	753	/** \endcond */
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	754
8c526cfe1399 Base files for new TTY driver. Florian Pose <fp@igh-essen.com> parents: diff changeset	755	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Fri, 22 Jan 2010 17:01:00 +0100
changeset 1784	bc2aff866a5b
parent 1782	2ba454c790c5
child 1786	7198caede741
permissions	-rw-r--r--