etherlabmaster: examples/tty/serial.c@2ba454c790c5 (annotated)

1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	1	/******************************************************************************
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	2	*
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	3	* $Id$
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	4	*
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	5	* Copyright (C) 2006-2008 Florian Pose, Ingenieurgemeinschaft IgH
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	6	*
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	7	* This file is part of the IgH EtherCAT Master.
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	8	*
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	9	* The IgH EtherCAT Master is free software; you can redistribute it and/or
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	10	* modify it under the terms of the GNU General Public License version 2, as
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	11	* published by the Free Software Foundation.
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	12	*
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	13	* The IgH EtherCAT Master is distributed in the hope that it will be useful,
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	16	* Public License for more details.
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	17	*
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	18	* You should have received a copy of the GNU General Public License along
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	19	* with the IgH EtherCAT Master; if not, write to the Free Software
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	20	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	21	*
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	22	* ---
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	23	*
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	24	* The license mentioned above concerns the source code only. Using the
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	25	* EtherCAT technology and brand is only permitted in compliance with the
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	26	* industrial property and similar rights of Beckhoff Automation GmbH.
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	27	*
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	28	*****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	29
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	30	#include <linux/module.h>
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	31	#include <linux/err.h>
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	32	#include <linux/termios.h>
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	33
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	34	#include "../../include/ecrt.h" // EtherCAT realtime interface
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	35	#include "../../include/ectty.h" // EtherCAT TTY interface
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	36
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	37	/*****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	38
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	39	// Optional features
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	40	#define PFX "ec_tty_example: "
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	41
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	42	#define DEBUG 0
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	43
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	44	/*****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	45
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	46	#define VendorIdBeckhoff 0x00000002
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	47	#define ProductCodeBeckhoffEL6002 0x17723052
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	48	#define Beckhoff_EL6002 VendorIdBeckhoff, ProductCodeBeckhoffEL6002
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	49
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	50	typedef enum {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	51	SER_REQUEST_INIT,
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	52	SER_WAIT_FOR_INIT_RESPONSE,
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	53	SER_READY,
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	54	SER_SET_RTSCTS,
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	55	SER_SET_BAUD_RATE,
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	56	SER_SET_DATA_FRAME,
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	57	} serial_state_t;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	58
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	59	typedef struct {
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	60	struct list_head list;
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	61
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	62	ec_tty_t *tty;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	63	ec_slave_config_t *sc;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	64
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	65	size_t max_tx_data_size;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	66	size_t max_rx_data_size;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	67
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	68	u8 *tx_data;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	69	u8 tx_data_size;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	70
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	71	serial_state_t state;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	72
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	73	u8 tx_request_toggle;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	74	u8 tx_accepted_toggle;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	75
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	76	u8 rx_request_toggle;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	77	u8 rx_accepted_toggle;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	78
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	79	u16 control;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	80
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	81	u32 off_ctrl;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	82	u32 off_tx;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	83	u32 off_status;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	84	u32 off_rx;
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	85
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	86	ec_sdo_request_t *rtscts_sdo;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	87	u8 requested_rtscts;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	88	u8 current_rtscts;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	89
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	90	ec_sdo_request_t *baud_sdo;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	91	u8 requested_baud_rate;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	92	u8 current_baud_rate;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	93
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	94	ec_sdo_request_t *frame_sdo;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	95	u8 requested_data_frame;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	96	u8 current_data_frame;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	97
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	98	unsigned int config_error;
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	99
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	100	} el6002_t;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	101
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	102	LIST_HEAD(handlers);
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	103
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	104	/*****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	105
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	106	/* Beckhoff EL6002
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	107	* Vendor ID: 0x00000002
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	108	* Product code: 0x17723052
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	109	* Revision number: 0x00100000
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	110	*/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	111
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	112	ec_pdo_entry_info_t el6002_pdo_entries[] = {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	113	{0x7001, 0x01, 16}, /* Ctrl */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	114	{0x7000, 0x11, 8}, /* Data Out 0 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	115	{0x7000, 0x12, 8}, /* Data Out 1 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	116	{0x7000, 0x13, 8}, /* Data Out 2 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	117	{0x7000, 0x14, 8}, /* Data Out 3 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	118	{0x7000, 0x15, 8}, /* Data Out 4 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	119	{0x7000, 0x16, 8}, /* Data Out 5 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	120	{0x7000, 0x17, 8}, /* Data Out 6 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	121	{0x7000, 0x18, 8}, /* Data Out 7 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	122	{0x7000, 0x19, 8}, /* Data Out 8 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	123	{0x7000, 0x1a, 8}, /* Data Out 9 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	124	{0x7000, 0x1b, 8}, /* Data Out 10 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	125	{0x7000, 0x1c, 8}, /* Data Out 11 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	126	{0x7000, 0x1d, 8}, /* Data Out 12 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	127	{0x7000, 0x1e, 8}, /* Data Out 13 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	128	{0x7000, 0x1f, 8}, /* Data Out 14 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	129	{0x7000, 0x20, 8}, /* Data Out 15 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	130	{0x7000, 0x21, 8}, /* Data Out 16 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	131	{0x7000, 0x22, 8}, /* Data Out 17 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	132	{0x7000, 0x23, 8}, /* Data Out 18 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	133	{0x7000, 0x24, 8}, /* Data Out 19 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	134	{0x7000, 0x25, 8}, /* Data Out 20 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	135	{0x7000, 0x26, 8}, /* Data Out 21 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	136	{0x7011, 0x01, 16}, /* Ctrl */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	137	{0x7010, 0x11, 8}, /* Data Out 0 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	138	{0x7010, 0x12, 8}, /* Data Out 1 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	139	{0x7010, 0x13, 8}, /* Data Out 2 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	140	{0x7010, 0x14, 8}, /* Data Out 3 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	141	{0x7010, 0x15, 8}, /* Data Out 4 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	142	{0x7010, 0x16, 8}, /* Data Out 5 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	143	{0x7010, 0x17, 8}, /* Data Out 6 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	144	{0x7010, 0x18, 8}, /* Data Out 7 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	145	{0x7010, 0x19, 8}, /* Data Out 8 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	146	{0x7010, 0x1a, 8}, /* Data Out 9 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	147	{0x7010, 0x1b, 8}, /* Data Out 10 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	148	{0x7010, 0x1c, 8}, /* Data Out 11 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	149	{0x7010, 0x1d, 8}, /* Data Out 12 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	150	{0x7010, 0x1e, 8}, /* Data Out 13 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	151	{0x7010, 0x1f, 8}, /* Data Out 14 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	152	{0x7010, 0x20, 8}, /* Data Out 15 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	153	{0x7010, 0x21, 8}, /* Data Out 16 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	154	{0x7010, 0x22, 8}, /* Data Out 17 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	155	{0x7010, 0x23, 8}, /* Data Out 18 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	156	{0x7010, 0x24, 8}, /* Data Out 19 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	157	{0x7010, 0x25, 8}, /* Data Out 20 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	158	{0x7010, 0x26, 8}, /* Data Out 21 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	159	{0x6001, 0x01, 16}, /* Status */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	160	{0x6000, 0x11, 8}, /* Data In 0 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	161	{0x6000, 0x12, 8}, /* Data In 1 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	162	{0x6000, 0x13, 8}, /* Data In 2 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	163	{0x6000, 0x14, 8}, /* Data In 3 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	164	{0x6000, 0x15, 8}, /* Data In 4 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	165	{0x6000, 0x16, 8}, /* Data In 5 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	166	{0x6000, 0x17, 8}, /* Data In 6 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	167	{0x6000, 0x18, 8}, /* Data In 7 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	168	{0x6000, 0x19, 8}, /* Data In 8 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	169	{0x6000, 0x1a, 8}, /* Data In 9 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	170	{0x6000, 0x1b, 8}, /* Data In 10 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	171	{0x6000, 0x1c, 8}, /* Data In 11 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	172	{0x6000, 0x1d, 8}, /* Data In 12 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	173	{0x6000, 0x1e, 8}, /* Data In 13 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	174	{0x6000, 0x1f, 8}, /* Data In 14 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	175	{0x6000, 0x20, 8}, /* Data In 15 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	176	{0x6000, 0x21, 8}, /* Data In 16 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	177	{0x6000, 0x22, 8}, /* Data In 17 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	178	{0x6000, 0x23, 8}, /* Data In 18 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	179	{0x6000, 0x24, 8}, /* Data In 19 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	180	{0x6000, 0x25, 8}, /* Data In 20 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	181	{0x6000, 0x26, 8}, /* Data In 21 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	182	{0x6011, 0x01, 16}, /* Status */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	183	{0x6010, 0x11, 8}, /* Data In 0 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	184	{0x6010, 0x12, 8}, /* Data In 1 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	185	{0x6010, 0x13, 8}, /* Data In 2 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	186	{0x6010, 0x14, 8}, /* Data In 3 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	187	{0x6010, 0x15, 8}, /* Data In 4 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	188	{0x6010, 0x16, 8}, /* Data In 5 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	189	{0x6010, 0x17, 8}, /* Data In 6 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	190	{0x6010, 0x18, 8}, /* Data In 7 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	191	{0x6010, 0x19, 8}, /* Data In 8 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	192	{0x6010, 0x1a, 8}, /* Data In 9 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	193	{0x6010, 0x1b, 8}, /* Data In 10 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	194	{0x6010, 0x1c, 8}, /* Data In 11 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	195	{0x6010, 0x1d, 8}, /* Data In 12 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	196	{0x6010, 0x1e, 8}, /* Data In 13 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	197	{0x6010, 0x1f, 8}, /* Data In 14 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	198	{0x6010, 0x20, 8}, /* Data In 15 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	199	{0x6010, 0x21, 8}, /* Data In 16 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	200	{0x6010, 0x22, 8}, /* Data In 17 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	201	{0x6010, 0x23, 8}, /* Data In 18 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	202	{0x6010, 0x24, 8}, /* Data In 19 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	203	{0x6010, 0x25, 8}, /* Data In 20 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	204	{0x6010, 0x26, 8}, /* Data In 21 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	205	};
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	206
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	207	ec_pdo_info_t el6002_pdos[] = {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	208	{0x1604, 23, el6002_pdo_entries + 0}, /* COM RxPDO-Map Outputs Ch.1 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	209	{0x1605, 23, el6002_pdo_entries + 23}, /* COM RxPDO-Map Outputs Ch.2 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	210	{0x1a04, 23, el6002_pdo_entries + 46}, /* COM TxPDO-Map Inputs Ch.1 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	211	{0x1a05, 23, el6002_pdo_entries + 69}, /* COM TxPDO-Map Inputs Ch.2 */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	212	};
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	213
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	214	ec_sync_info_t el6002_syncs[] = {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	215	{0, EC_DIR_OUTPUT, 0, NULL, EC_WD_DISABLE},
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	216	{1, EC_DIR_INPUT, 0, NULL, EC_WD_DISABLE},
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	217	{2, EC_DIR_OUTPUT, 2, el6002_pdos + 0, EC_WD_DISABLE},
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	218	{3, EC_DIR_INPUT, 2, el6002_pdos + 2, EC_WD_DISABLE},
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	219	{0xff}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	220	};
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	221
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	222	typedef enum {
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	223	PAR_NONE,
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	224	PAR_ODD,
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	225	PAR_EVEN
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	226	} parity_t;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	227
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	228	typedef struct {
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	229	u8 value;
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	230	unsigned int data_bits;
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	231	parity_t parity;
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	232	unsigned int stop_bits;
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	233	} el600x_data_frame_t;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	234
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	235	/** EL600x supported values for data frame SDO.
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	236	*/
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	237	el600x_data_frame_t el600x_data_frame[] = {
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	238	{0x01, 7, PAR_EVEN, 1},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	239	{0x09, 7, PAR_EVEN, 2},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	240	{0x02, 7, PAR_ODD, 1},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	241	{0x0a, 7, PAR_ODD, 2},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	242	{0x03, 8, PAR_NONE, 1},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	243	{0x0b, 8, PAR_NONE, 2},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	244	{0x04, 8, PAR_EVEN, 1},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	245	{0x0c, 8, PAR_EVEN, 2},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	246	{0x05, 8, PAR_ODD, 1},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	247	{0x0d, 8, PAR_ODD, 2},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	248	};
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	249
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	250	typedef struct {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	251	u8 value;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	252	unsigned int baud;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	253	tcflag_t cbaud;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	254	} el600x_baud_rate_t;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	255
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	256	/** EL600x supported values for baud rate SDO.
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	257	*/
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	258	el600x_baud_rate_t el600x_baud_rate[] = {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	259	{1, 300, B300},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	260	{2, 600, B600},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	261	{3, 1200, B1200},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	262	{4, 2400, B2400},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	263	{5, 4800, B4800},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	264	{6, 9600, B9600},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	265	{7, 19200, B19200},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	266	{8, 38400, B38400},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	267	{9, 57600, B57600},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	268	{10, 115200, B115200}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	269	};
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	270
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	271	/****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	272
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	273	int el6002_cflag_changed(void *data, tcflag_t cflag)
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	274	{
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	275	el6002_t ser = (el6002_t ) data;
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	276	unsigned int data_bits, stop_bits;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	277	tcflag_t cbaud, rtscts;
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	278	parity_t par;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	279	unsigned int i;
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	280	el600x_baud_rate_t *b_to_use = NULL;
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	281	el600x_data_frame_t *df_to_use = NULL;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	282
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	283	#if DEBUG
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	284	printk(KERN_INFO PFX "%s(data=%p, cflag=%x).\n", __func__, ser, cflag);
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	285	#endif
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	286
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	287	rtscts = cflag & CRTSCTS;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	288	printk(KERN_INFO PFX "Requested rts/cts: %s.\n", rtscts ? "yes" : "no");
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	289
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	290	cbaud = cflag & CBAUD;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	291
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	292	for (i = 0; i < sizeof(el600x_baud_rate) / sizeof(el600x_baud_rate_t);
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	293	i++) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	294	el600x_baud_rate_t *b = el600x_baud_rate + i;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	295	if (b->cbaud == cbaud) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	296	b_to_use = b;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	297	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	298	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	299	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	300
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	301	if (b_to_use) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	302	printk(KERN_INFO PFX "Requested baud rate: %u.\n", b_to_use->baud);
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	303	} else {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	304	printk(KERN_ERR PFX "Error: Baud rate index %x not supported.\n",
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	305	cbaud);
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	306	return -EINVAL;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	307	}
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	308
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	309	switch (cflag & CSIZE) {
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	310	case CS5:
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	311	data_bits = 5;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	312	break;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	313	case CS6:
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	314	data_bits = 6;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	315	break;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	316	case CS7:
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	317	data_bits = 7;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	318	break;
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	319	case CS8:
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	320	data_bits = 8;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	321	break;
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	322	default: /* CS5 or CS6 */
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	323	data_bits = 0;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	324	}
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	325
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	326	if (cflag & PARENB) {
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	327	par = (cflag & PARODD) ? PAR_ODD : PAR_EVEN;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	328	} else {
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	329	par = PAR_NONE;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	330	}
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	331
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	332	stop_bits = (cflag & CSTOPB) ? 2 : 1;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	333
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	334	printk(KERN_INFO PFX "Requested Data frame: %u%c%u.\n",
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	335	data_bits,
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	336	(par == PAR_NONE ? 'N' : (par == PAR_ODD ? 'O' : 'E')),
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	337	stop_bits);
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	338
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	339	for (i = 0; i < sizeof(el600x_data_frame) / sizeof(el600x_data_frame_t);
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	340	i++) {
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	341	el600x_data_frame_t *df = el600x_data_frame + i;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	342	if (df->data_bits == data_bits &&
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	343	df->parity == par &&
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	344	df->stop_bits == stop_bits) {
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	345	df_to_use = df;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	346	break;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	347	}
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	348	}
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	349
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	350	if (!df_to_use) {
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	351	printk(KERN_ERR PFX "Error: Data frame type not supported.\n");
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	352	return -EINVAL;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	353	}
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	354
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	355	ser->requested_rtscts = rtscts != 0;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	356	ser->requested_baud_rate = b_to_use->value;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	357	ser->requested_data_frame = df_to_use->value;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	358	ser->config_error = 0;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	359	return 0;
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	360	}
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	361
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	362	/****************************************************************************/
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	363
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	364	int el6002_init(el6002_t ser, ec_master_t master, u16 position,
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	365	ec_domain_t *domain)
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	366	{
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	367	int ret = 0;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	368
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	369	ser->tty = ectty_create(el6002_cflag_changed, ser);
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	370	if (IS_ERR(ser->tty)) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	371	printk(KERN_ERR PFX "Failed to create tty.\n");
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	372	ret = PTR_ERR(ser->tty);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	373	goto out_return;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	374	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	375
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	376	ser->sc = NULL;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	377	ser->max_tx_data_size = 22;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	378	ser->max_rx_data_size = 22;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	379	ser->tx_data = NULL;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	380	ser->tx_data_size = 0;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	381	ser->state = SER_REQUEST_INIT;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	382	ser->tx_request_toggle = 0;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	383	ser->rx_accepted_toggle = 0;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	384	ser->control = 0x0000;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	385	ser->off_ctrl = 0;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	386	ser->off_tx = 0;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	387	ser->off_status = 0;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	388	ser->off_rx = 0;
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	389	ser->requested_rtscts = 0x00; // no hardware handshake
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	390	ser->current_rtscts = 0xff;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	391	ser->requested_baud_rate = 6; // 9600
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	392	ser->current_baud_rate = 0;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	393	ser->requested_data_frame = 0x03; // 8N1
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	394	ser->current_data_frame = 0x00;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	395	ser->config_error = 0;
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	396
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	397	if (!(ser->sc = ecrt_master_slave_config(
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	398	master, 0, position, Beckhoff_EL6002))) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	399	printk(KERN_ERR PFX "Failed to create slave configuration.\n");
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	400	ret = -EBUSY;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	401	goto out_free_tty;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	402	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	403
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	404	if (!(ser->rtscts_sdo = ecrt_slave_config_create_sdo_request(ser->sc,
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	405	0x8000, 0x01, 1))) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	406	printk(KERN_ERR PFX "Failed to create SDO request.\n");
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	407	ret = -ENOMEM;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	408	goto out_free_tty;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	409	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	410
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	411	if (!(ser->baud_sdo = ecrt_slave_config_create_sdo_request(ser->sc,
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	412	0x8000, 0x11, 1))) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	413	printk(KERN_ERR PFX "Failed to create SDO request.\n");
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	414	ret = -ENOMEM;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	415	goto out_free_tty;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	416	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	417
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	418	if (!(ser->frame_sdo = ecrt_slave_config_create_sdo_request(ser->sc,
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	419	0x8000, 0x15, 1))) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	420	printk(KERN_ERR PFX "Failed to create SDO request.\n");
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	421	ret = -ENOMEM;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	422	goto out_free_tty;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	423	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	424
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	425	if (ecrt_slave_config_pdos(ser->sc, EC_END, el6002_syncs)) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	426	printk(KERN_ERR PFX "Failed to configure PDOs.\n");
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	427	ret = -ENOMEM;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	428	goto out_free_tty;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	429	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	430
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	431	ret = ecrt_slave_config_reg_pdo_entry(
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	432	ser->sc, 0x7001, 0x01, domain, NULL);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	433	if (ret < 0) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	434	printk(KERN_ERR PFX "Failed to register PDO entry.\n");
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	435	goto out_free_tty;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	436	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	437	ser->off_ctrl = ret;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	438
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	439	ret = ecrt_slave_config_reg_pdo_entry(
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	440	ser->sc, 0x7000, 0x11, domain, NULL);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	441	if (ret < 0) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	442	printk(KERN_ERR PFX "Failed to register PDO entry.\n");
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	443	goto out_free_tty;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	444	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	445	ser->off_tx = ret;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	446
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	447	ret = ecrt_slave_config_reg_pdo_entry(
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	448	ser->sc, 0x6001, 0x01, domain, NULL);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	449	if (ret < 0) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	450	printk(KERN_ERR PFX "Failed to register PDO entry.\n");
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	451	goto out_free_tty;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	452	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	453	ser->off_status = ret;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	454
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	455	ret = ecrt_slave_config_reg_pdo_entry(
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	456	ser->sc, 0x6000, 0x11, domain, NULL);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	457	if (ret < 0) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	458	printk(KERN_ERR PFX "Failed to register PDO entry.\n");
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	459	goto out_free_tty;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	460	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	461	ser->off_rx = ret;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	462
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	463	if (ser->max_tx_data_size > 0) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	464	ser->tx_data = kmalloc(ser->max_tx_data_size, GFP_KERNEL);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	465	if (ser->tx_data == NULL) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	466	ret = -ENOMEM;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	467	goto out_free_tty;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	468	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	469	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	470
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	471	return 0;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	472
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	473	out_free_tty:
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	474	ectty_free(ser->tty);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	475	out_return:
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	476	return ret;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	477	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	478
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	479	/****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	480
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	481	void el6002_clear(el6002_t *ser)
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	482	{
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	483	ectty_free(ser->tty);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	484	if (ser->tx_data) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	485	kfree(ser->tx_data);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	486	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	487	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	488
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	489	/****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	490
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	491	void el6002_run(el6002_t ser, u8 pd)
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	492	{
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	493	u16 status = EC_READ_U16(pd + ser->off_status);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	494	u8 *rx_data = pd + ser->off_rx;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	495	uint8_t tx_accepted_toggle, rx_request_toggle;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	496
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	497	switch (ser->state) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	498	case SER_READY:
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	499
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	500	/* Check, if hardware handshaking has to be configured. */
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	501	if (!ser->config_error &&
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	502	ser->requested_rtscts != ser->current_rtscts) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	503	EC_WRITE_U8(ecrt_sdo_request_data(ser->rtscts_sdo),
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	504	ser->requested_rtscts);
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	505	ecrt_sdo_request_write(ser->rtscts_sdo);
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	506	ser->state = SER_SET_RTSCTS;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	507	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	508	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	509
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	510	/* Check, if the baud rate has to be configured. */
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	511	if (!ser->config_error &&
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	512	ser->requested_baud_rate != ser->current_baud_rate) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	513	EC_WRITE_U8(ecrt_sdo_request_data(ser->baud_sdo),
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	514	ser->requested_baud_rate);
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	515	ecrt_sdo_request_write(ser->baud_sdo);
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	516	ser->state = SER_SET_BAUD_RATE;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	517	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	518	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	519
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	520	/* Check, if the data frame has to be configured. */
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	521	if (!ser->config_error &&
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	522	ser->requested_data_frame != ser->current_data_frame) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	523	EC_WRITE_U8(ecrt_sdo_request_data(ser->frame_sdo),
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	524	ser->requested_data_frame);
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	525	ecrt_sdo_request_write(ser->frame_sdo);
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	526	ser->state = SER_SET_DATA_FRAME;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	527	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	528	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	529
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	530	/* Send data */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	531
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	532	tx_accepted_toggle = status & 0x0001;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	533	if (tx_accepted_toggle != ser->tx_accepted_toggle) { // ready
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	534	ser->tx_data_size =
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	535	ectty_tx_data(ser->tty, ser->tx_data, ser->max_tx_data_size);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	536	if (ser->tx_data_size) {
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	537	#if DEBUG
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	538	printk(KERN_INFO PFX "Sending %u bytes.\n", ser->tx_data_size);
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	539	#endif
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	540	ser->tx_request_toggle = !ser->tx_request_toggle;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	541	ser->tx_accepted_toggle = tx_accepted_toggle;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	542	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	543	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	544
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	545	/* Receive data */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	546
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	547	rx_request_toggle = status & 0x0002;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	548	if (rx_request_toggle != ser->rx_request_toggle) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	549	uint8_t rx_data_size = status >> 8;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	550	ser->rx_request_toggle = rx_request_toggle;
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	551	#if DEBUG
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	552	printk(KERN_INFO PFX "Received %u bytes.\n", rx_data_size);
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	553	#endif
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	554	ectty_rx_data(ser->tty, rx_data, rx_data_size);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	555	ser->rx_accepted_toggle = !ser->rx_accepted_toggle;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	556	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	557
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	558	ser->control =
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	559	ser->tx_request_toggle \|
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	560	ser->rx_accepted_toggle << 1 \|
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	561	ser->tx_data_size << 8;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	562	break;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	563
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	564	case SER_REQUEST_INIT:
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	565	if (status & (1 << 2)) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	566	ser->control = 0x0000;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	567	ser->state = SER_WAIT_FOR_INIT_RESPONSE;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	568	} else {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	569	ser->control = 1 << 2; // CW.2, request initialization
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	570	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	571	break;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	572
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	573	case SER_WAIT_FOR_INIT_RESPONSE:
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	574	if (!(status & (1 << 2))) {
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	575	printk(KERN_INFO PFX "EL600x init successful.\n");
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	576	ser->tx_accepted_toggle = 1;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	577	ser->control = 0x0000;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	578	ser->state = SER_READY;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	579	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	580	break;
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	581
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	582	case SER_SET_RTSCTS:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	583	switch (ecrt_sdo_request_state(ser->rtscts_sdo)) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	584	case EC_REQUEST_SUCCESS:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	585	printk(KERN_INFO PFX "Slave accepted rts/cts.\n");
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	586	ser->current_rtscts = ser->requested_rtscts;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	587	ser->state = SER_REQUEST_INIT;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	588	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	589	case EC_REQUEST_ERROR:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	590	printk(KERN_INFO PFX "Failed to set rts/cts!\n");
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	591	ser->state = SER_REQUEST_INIT;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	592	ser->config_error = 1;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	593	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	594	default:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	595	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	596	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	597	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	598
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	599	case SER_SET_BAUD_RATE:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	600	switch (ecrt_sdo_request_state(ser->baud_sdo)) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	601	case EC_REQUEST_SUCCESS:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	602	printk(KERN_INFO PFX "Slave accepted baud rate.\n");
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	603	ser->current_baud_rate = ser->requested_baud_rate;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	604	ser->state = SER_REQUEST_INIT;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	605	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	606	case EC_REQUEST_ERROR:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	607	printk(KERN_INFO PFX "Failed to set baud rate!\n");
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	608	ser->state = SER_REQUEST_INIT;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	609	ser->config_error = 1;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	610	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	611	default:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	612	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	613	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	614	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	615
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	616	case SER_SET_DATA_FRAME:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	617	switch (ecrt_sdo_request_state(ser->frame_sdo)) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	618	case EC_REQUEST_SUCCESS:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	619	printk(KERN_INFO PFX "Slave accepted data frame.\n");
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	620	ser->current_data_frame = ser->requested_data_frame;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	621	ser->state = SER_REQUEST_INIT;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	622	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	623	case EC_REQUEST_ERROR:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	624	printk(KERN_INFO PFX "Failed to set data frame!\n");
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	625	ser->state = SER_REQUEST_INIT;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	626	ser->config_error = 1;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	627	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	628	default:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	629	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	630	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	631	break;
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	632	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	633
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	634	EC_WRITE_U16(pd + ser->off_ctrl, ser->control);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	635	memcpy(pd + ser->off_tx, ser->tx_data, ser->tx_data_size);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	636	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	637
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	638	/*****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	639
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	640	void run_serial_devices(u8 *pd)
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	641	{
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	642	el6002_t *ser;
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	643
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	644	list_for_each_entry(ser, &handlers, list) {
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	645	el6002_run(ser, pd);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	646	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	647	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	648
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	649	/*****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	650
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	651	int create_serial_devices(ec_master_t master, ec_domain_t domain)
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	652	{
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	653	int i, ret;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	654	ec_master_info_t master_info;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	655	ec_slave_info_t slave_info;
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	656	el6002_t ser, next;
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	657
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	658	printk(KERN_INFO PFX "Registering serial devices...\n");
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	659
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	660	ret = ecrt_master(master, &master_info);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	661	if (ret) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	662	printk(KERN_ERR PFX "Failed to obtain master information.\n");
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	663	goto out_return;
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	664	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	665
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	666	for (i = 0; i < master_info.slave_count; i++) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	667	ret = ecrt_master_get_slave(master, i, &slave_info);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	668	if (ret) {
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	669	printk(KERN_ERR PFX "Failed to obtain slave information.\n");
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	670	goto out_free_handlers;
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	671	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	672
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	673	if (slave_info.vendor_id != VendorIdBeckhoff
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	674	\|\| slave_info.product_code != ProductCodeBeckhoffEL6002) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	675	continue;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	676	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	677
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	678	printk(KERN_INFO PFX "Creating handler for serial device"
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	679	" at position %i\n", i);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	680
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	681	ser = kmalloc(sizeof(*ser), GFP_KERNEL);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	682	if (!ser) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	683	printk(KERN_ERR PFX "Failed to allocate serial device object.\n");
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	684	ret = -ENOMEM;
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	685	goto out_free_handlers;
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	686	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	687
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	688	ret = el6002_init(ser, master, i, domain);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	689	if (ret) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	690	printk(KERN_ERR PFX "Failed to init serial device object.\n");
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	691	kfree(ser);
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	692	goto out_free_handlers;
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	693	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	694
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	695	list_add_tail(&ser->list, &handlers);
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	696	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	697
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	698
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	699	printk(KERN_INFO PFX "Finished.\n");
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	700	return 0;
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	701
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	702	out_free_handlers:
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	703	list_for_each_entry_safe(ser, next, &handlers, list) {
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	704	list_del(&ser->list);
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	705	el6002_clear(ser);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	706	kfree(ser);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	707	}
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	708	out_return:
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	709	return ret;
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	710	}
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	711
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	712	/*****************************************************************************/
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	713
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	714	void free_serial_devices(void)
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	715	{
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	716	el6002_t ser, next;
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	717
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	718	printk(KERN_INFO PFX "Cleaning up serial devices...\n");
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	719
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	720	list_for_each_entry_safe(ser, next, &handlers, list) {
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	721	list_del(&ser->list);
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	722	el6002_clear(ser);
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	723	kfree(ser);
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	724	}
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	725
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	726	printk(KERN_INFO PFX "Finished cleaning up serial devices.\n");
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	727	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	728
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	729	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Fri, 22 Jan 2010 14:10:18 +0100
changeset 1782	2ba454c790c5
parent 1780	11f452ca4d7a
child 1783	8fd654d9ed5c
permissions	-rw-r--r--