etherlabmaster: examples/tty/serial.c@8fd654d9ed5c (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
1783 8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	48
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	49	#define VendorIdIds 0x000012ad
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	50	#define ProductCodeIdsCSI71A 0x17723052
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	51
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	52	/*****************************************************************************/
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	53
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	54	typedef enum {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	55	SER_REQUEST_INIT,
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	56	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	57	SER_READY,
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	58	SER_SET_RTSCTS,
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	59	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	60	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	61	} serial_state_t;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	62
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	63	typedef struct {
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	64	struct list_head list;
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	65
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	66	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	67	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	68
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	69	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	70	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	71
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	72	u8 *tx_data;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	73	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	74
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	75	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	76
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	77	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	78	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	79
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	80	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	81	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	82
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	83	u16 control;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	84
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	85	u32 off_ctrl;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	86	u32 off_tx;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	87	u32 off_status;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	88	u32 off_rx;
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	89
1782 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 *rtscts_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_rtscts;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	92	u8 current_rtscts;
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 *baud_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_baud_rate;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	96	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	97
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	98	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	99	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	100	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	101
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	102	unsigned int config_error;
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	103
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	104	} el6002_t;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	105
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	106	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	107
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	108	/*****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	109
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	110	/* Beckhoff EL6002
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	111	* Vendor ID: 0x00000002
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	112	* Product code: 0x17723052
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	113	* Revision number: 0x00100000
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	114	*/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	115
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	116	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	117	{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	118	{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	119	{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	120	{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	121	{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	122	{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	123	{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	124	{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	125	{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	126	{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	127	{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	128	{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	129	{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	130	{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	131	{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	132	{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	133	{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	134	{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	135	{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	136	{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	137	{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	138	{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	139	{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	140	{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	141	{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	142	{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	143	{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	144	{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	145	{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	146	{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	147	{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	148	{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	149	{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	150	{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	151	{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	152	{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	153	{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	154	{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	155	{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	156	{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	157	{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	158	{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	159	{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	160	{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	161	{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	162	{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	163	{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	164	{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	165	{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	166	{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	167	{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	168	{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	169	{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	170	{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	171	{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	172	{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	173	{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	174	{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	175	{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	176	{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	177	{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	178	{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	179	{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	180	{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	181	{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	182	{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	183	{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	184	{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	185	{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	186	{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	187	{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	188	{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	189	{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	190	{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	191	{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	192	{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	193	{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	194	{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	195	{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	196	{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	197	{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	198	{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	199	{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	200	{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	201	{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	202	{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	203	{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	204	{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	205	{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	206	{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	207	{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	208	{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	209	};
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	210
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	211	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	212	{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	213	{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	214	{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	215	{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	216	};
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	217
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	218	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	219	{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	220	{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	221	{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	222	{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	223	{0xff}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	224	};
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	225
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	226	typedef enum {
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	227	PAR_NONE,
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	228	PAR_ODD,
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	229	PAR_EVEN
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	230	} parity_t;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	231
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	232	typedef struct {
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	233	u8 value;
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	234	unsigned int data_bits;
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	235	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	236	unsigned int stop_bits;
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	237	} el600x_data_frame_t;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	238
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	239	/** EL600x supported values for data frame SDO.
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	240	*/
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	241	el600x_data_frame_t el600x_data_frame[] = {
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	242	{0x01, 7, PAR_EVEN, 1},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	243	{0x09, 7, PAR_EVEN, 2},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	244	{0x02, 7, PAR_ODD, 1},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	245	{0x0a, 7, PAR_ODD, 2},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	246	{0x03, 8, PAR_NONE, 1},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	247	{0x0b, 8, PAR_NONE, 2},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	248	{0x04, 8, PAR_EVEN, 1},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	249	{0x0c, 8, PAR_EVEN, 2},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	250	{0x05, 8, PAR_ODD, 1},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	251	{0x0d, 8, PAR_ODD, 2},
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	252	};
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	253
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	254	typedef struct {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	255	u8 value;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	256	unsigned int baud;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	257	tcflag_t cbaud;
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;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	259
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	260	/** 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	261	*/
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	262	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	263	{1, 300, B300},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	264	{2, 600, B600},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	265	{3, 1200, B1200},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	266	{4, 2400, B2400},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	267	{5, 4800, B4800},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	268	{6, 9600, B9600},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	269	{7, 19200, B19200},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	270	{8, 38400, B38400},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	271	{9, 57600, B57600},
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	272	{10, 115200, B115200}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	273	};
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	274
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	275	/****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	276
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	277	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	278	{
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	279	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	280	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	281	tcflag_t cbaud, rtscts;
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	282	parity_t par;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	283	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	284	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	285	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	286
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	287	#if DEBUG
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	288	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	289	#endif
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	290
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	291	rtscts = cflag & CRTSCTS;
1783 8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	292	printk(KERN_INFO PFX "Requested RTS/CTS: %s.\n", rtscts ? "yes" : "no");
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	293
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	294	cbaud = cflag & CBAUD;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	295
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	296	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	297	i++) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	298	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	299	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	300	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	301	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	302	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	303	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	304
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	305	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	306	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	307	} else {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	308	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	309	cbaud);
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	310	return -EINVAL;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	311	}
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	312
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	313	switch (cflag & CSIZE) {
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	314	case CS5:
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	315	data_bits = 5;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	316	break;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	317	case CS6:
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	318	data_bits = 6;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	319	break;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	320	case CS7:
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	321	data_bits = 7;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	322	break;
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	323	case CS8:
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	324	data_bits = 8;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	325	break;
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	326	default: /* CS5 or CS6 */
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	327	data_bits = 0;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	328	}
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	329
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	330	if (cflag & PARENB) {
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	331	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	332	} else {
1780 11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	333	par = PAR_NONE;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	334	}
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	335
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	336	stop_bits = (cflag & CSTOPB) ? 2 : 1;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	337
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	338	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	339	data_bits,
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	340	(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	341	stop_bits);
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	342
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	343	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	344	i++) {
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	345	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	346	if (df->data_bits == data_bits &&
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	347	df->parity == par &&
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	348	df->stop_bits == stop_bits) {
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	349	df_to_use = df;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	350	break;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	351	}
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	352	}
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	if (!df_to_use) {
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	355	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	356	return -EINVAL;
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	357	}
11f452ca4d7a Check EL600x frame data configuration. Florian Pose <fp@igh-essen.com> parents: 1779 diff changeset	358
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	359	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	360	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	361	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	362	ser->config_error = 0;
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	363	return 0;
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	364	}
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	365
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	366	/****************************************************************************/
9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	367
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	368	int el6002_init(el6002_t ser, ec_master_t master, u16 position,
1783 8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	369	ec_domain_t *domain, u32 vendor, u32 product)
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	370	{
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	371	int ret = 0;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	372
1779 9fab229d6ca9 Passing tty cflag to serial implementation. Florian Pose <fp@igh-essen.com> parents: 1615 diff changeset	373	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	374	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	375	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	376	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	377	goto out_return;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	378	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	379
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	380	ser->sc = NULL;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	381	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	382	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	383	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	384	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	385	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	386	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	387	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	388	ser->control = 0x0000;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	389	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	390	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	391	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	392	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	393	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	394	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	395	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	396	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	397	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	398	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	399	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	400
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	401	if (!(ser->sc = ecrt_master_slave_config(
1783 8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	402	master, 0, position, vendor, product))) {
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	403	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	404	ret = -EBUSY;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	405	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	406	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	407
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	408	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	409	0x8000, 0x01, 1))) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	410	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	411	ret = -ENOMEM;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	412	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	413	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	414
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	415	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	416	0x8000, 0x11, 1))) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	417	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	418	ret = -ENOMEM;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	419	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	420	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	421
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	422	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	423	0x8000, 0x15, 1))) {
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	424	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	425	ret = -ENOMEM;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	426	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	427	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	428
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	429	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	430	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	431	ret = -ENOMEM;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	432	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	433	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	434
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	435	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	436	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	437	if (ret < 0) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	438	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	439	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	440	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	441	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	442
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	443	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	444	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	445	if (ret < 0) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	446	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	447	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	448	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	449	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	450
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	451	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	452	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	453	if (ret < 0) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	454	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	455	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	456	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	457	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	458
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	459	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	460	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	461	if (ret < 0) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	462	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	463	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	464	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	465	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	466
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	467	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	468	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	469	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	470	ret = -ENOMEM;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	471	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	472	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	473	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	474
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	475	return 0;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	476
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	477	out_free_tty:
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	478	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	479	out_return:
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	480	return ret;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	481	}
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	/****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	484
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	485	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	486	{
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	487	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	488	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	489	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	490	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	491	}
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	/****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	494
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	495	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	496	{
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	497	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	498	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	499	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	500
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	501	switch (ser->state) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	502	case SER_READY:
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	503
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	504	/* 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	505	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	506	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	507	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	508	ser->requested_rtscts);
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	509	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	510	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	511	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	512	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	513
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	514	/* 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	515	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	516	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	517	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	518	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	519	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	520	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	521	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	522	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	523
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	524	/* 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	525	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	526	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	527	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	528	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	529	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	530	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	531	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	532	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	533
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	534	/* Send data */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	535
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	536	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	537	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	538	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	539	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	540	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	541	#if DEBUG
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	542	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	543	#endif
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	544	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	545	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	546	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	547	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	548
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	549	/* Receive data */
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	550
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	551	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	552	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	553	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	554	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	555	#if DEBUG
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	556	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	557	#endif
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	558	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	559	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	560	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	561
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	562	ser->control =
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	563	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	564	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	565	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	566	break;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	567
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	568	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	569	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	570	ser->control = 0x0000;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	571	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	572	} else {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	573	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	574	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	575	break;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	576
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	577	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	578	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	579	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	580	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	581	ser->control = 0x0000;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	582	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	583	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	584	break;
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	585
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	586	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	587	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	588	case EC_REQUEST_SUCCESS:
1783 8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	589	printk(KERN_INFO PFX "Slave accepted RTS/CTS.\n");
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	590	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	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	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	593	case EC_REQUEST_ERROR:
1783 8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	594	printk(KERN_INFO PFX "Failed to set RTS/CTS!\n");
1782 2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	595	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	596	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	597	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	598	default:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	599	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	600	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	601	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	602
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	603	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	604	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	605	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	606	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	607	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	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	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	610	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	611	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	612	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	613	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	614	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	615	default:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	616	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	617	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	618	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	619
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	620	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	621	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	622	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	623	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	624	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	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	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	627	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	628	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	629	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	630	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	631	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	632	default:
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	633	break;
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	634	}
2ba454c790c5 Implemented setting of baud rate, data frame and RTS/CTS. Florian Pose <fp@igh-essen.com> parents: 1780 diff changeset	635	break;
1613 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	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	639	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	640	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	641
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	642	/*****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	643
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	644	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	645	{
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	646	el6002_t *ser;
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	647
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	648	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	649	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	650	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	651	}
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	/*****************************************************************************/
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	654
1783 8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	655	int create_el6002_handler(ec_master_t master, ec_domain_t domain,
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	656	u16 position, u32 vendor, u32 product)
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	657	{
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	658	el6002_t *ser;
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	659	int ret;
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	660
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	661	printk(KERN_INFO PFX "Creating handler for EL6002 at position %u\n",
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	662	position);
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	663
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	664	ser = kmalloc(sizeof(*ser), GFP_KERNEL);
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	665	if (!ser) {
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	666	printk(KERN_ERR PFX "Failed to allocate serial device object.\n");
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	667	return -ENOMEM;
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	668	}
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	669
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	670	ret = el6002_init(ser, master, position, domain, vendor, product);
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	671	if (ret) {
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	672	printk(KERN_ERR PFX "Failed to init serial device object.\n");
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	673	kfree(ser);
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	674	return ret;
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	675	}
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	676
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	677	list_add_tail(&ser->list, &handlers);
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	678	return 0;
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	679	}
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	680
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	681	/*****************************************************************************/
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	682
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	683	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	684	{
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	685	int i, ret;
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	686	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	687	ec_slave_info_t slave_info;
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	688	el6002_t ser, next;
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	689
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	690	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	691
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	692	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	693	if (ret) {
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	694	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	695	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	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	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	699	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	700	if (ret) {
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	701	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	702	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	703	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	704
1783 8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	705	if (slave_info.vendor_id == VendorIdBeckhoff
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	706	&& slave_info.product_code == ProductCodeBeckhoffEL6002) {
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	707	if (create_el6002_handler(master, domain, i,
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	708	slave_info.vendor_id, slave_info.product_code)) {
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	709	goto out_free_handlers;
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	710	}
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	711	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	712
1783 8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	713	if (slave_info.vendor_id == VendorIdIds
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	714	&& slave_info.product_code == ProductCodeIdsCSI71A) {
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	715	if (create_el6002_handler(master, domain, i,
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	716	slave_info.vendor_id, slave_info.product_code)) {
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	717	goto out_free_handlers;
8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	718	}
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	719	}
1783 8fd654d9ed5c Also accept ids 2-port serial slave. Florian Pose <fp@igh-essen.com> parents: 1782 diff changeset	720	}
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	721
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	722	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	723	return 0;
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	724
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	725	out_free_handlers:
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	726	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	727	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	728	el6002_clear(ser);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	729	kfree(ser);
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	730	}
1615 020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	731	out_return:
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	732	return ret;
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	733	}
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	734
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	735	/*****************************************************************************/
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	736
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	737	void free_serial_devices(void)
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	738	{
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	739	el6002_t ser, next;
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	740
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	741	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	742
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	743	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	744	list_del(&ser->list);
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	745	el6002_clear(ser);
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	746	kfree(ser);
020ad9ad3afb TTY example: Auto-create multiple handlers. Florian Pose <fp@igh-essen.com> parents: 1614 diff changeset	747	}
1613 070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	748
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	749	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	750	}
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	751
070b4b420ab1 TTY: Sourced serial device functions out into serial.c/serial.h. Florian Pose <fp@igh-essen.com> parents: diff changeset	752	/*****************************************************************************/

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