etherlabmaster: master/master.c@652180478e95 (annotated)

39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1	/******************************************************************************
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	2	*
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	3	* $Id$
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	4	*
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	5	* Copyright (C) 2006 Florian Pose, Ingenieurgemeinschaft IgH
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	6	*
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	7	* This file is part of the IgH EtherCAT Master.
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	8	*
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	9	* The IgH EtherCAT Master is free software; you can redistribute it
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	10	* and/or modify it under the terms of the GNU General Public License
246 0bf7c769de06 Changed license headers and added EtherCAT license notice. Florian Pose <fp@igh-essen.com> parents: 239 diff changeset	11	* as published by the Free Software Foundation; either version 2 of the
0bf7c769de06 Changed license headers and added EtherCAT license notice. Florian Pose <fp@igh-essen.com> parents: 239 diff changeset	12	* License, or (at your option) any later version.
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	13	*
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	14	* The IgH EtherCAT Master is distributed in the hope that it will be
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	15	* useful, but WITHOUT ANY WARRANTY; without even the implied warranty of
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	16	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	17	* GNU General Public License for more details.
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	18	*
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	19	* You should have received a copy of the GNU General Public License
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	20	* along with the IgH EtherCAT Master; if not, write to the Free Software
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	21	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	22	*
246 0bf7c769de06 Changed license headers and added EtherCAT license notice. Florian Pose <fp@igh-essen.com> parents: 239 diff changeset	23	* The right to use EtherCAT Technology is granted and comes free of
0bf7c769de06 Changed license headers and added EtherCAT license notice. Florian Pose <fp@igh-essen.com> parents: 239 diff changeset	24	* charge under condition of compatibility of product made by
0bf7c769de06 Changed license headers and added EtherCAT license notice. Florian Pose <fp@igh-essen.com> parents: 239 diff changeset	25	* Licensee. People intending to distribute/sell products based on the
0bf7c769de06 Changed license headers and added EtherCAT license notice. Florian Pose <fp@igh-essen.com> parents: 239 diff changeset	26	* code, have to sign an agreement to guarantee that products using
0bf7c769de06 Changed license headers and added EtherCAT license notice. Florian Pose <fp@igh-essen.com> parents: 239 diff changeset	27	* software based on IgH EtherCAT master stay compatible with the actual
0bf7c769de06 Changed license headers and added EtherCAT license notice. Florian Pose <fp@igh-essen.com> parents: 239 diff changeset	28	* EtherCAT specification (which are released themselves as an open
0bf7c769de06 Changed license headers and added EtherCAT license notice. Florian Pose <fp@igh-essen.com> parents: 239 diff changeset	29	* standard) as the (only) precondition to have the right to use EtherCAT
0bf7c769de06 Changed license headers and added EtherCAT license notice. Florian Pose <fp@igh-essen.com> parents: 239 diff changeset	30	* Technology, IP and trade marks.
0bf7c769de06 Changed license headers and added EtherCAT license notice. Florian Pose <fp@igh-essen.com> parents: 239 diff changeset	31	*
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	32	*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	33
199 04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	34	/**
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	35	\file
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	36	EtherCAT master methods.
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	37	*/
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	38
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	39	/*****************************************************************************/
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	40
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	41	#include <linux/module.h>
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	42	#include <linux/kernel.h>
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	43	#include <linux/string.h>
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	44	#include <linux/slab.h>
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	45	#include <linux/delay.h>
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	46
104 052bc82d5442 MERGE branches/async -> trunk (alle Unterschiede ?bernommen) Florian Pose <fp@igh-essen.com> parents: 101 diff changeset	47	#include "../include/ecrt.h"
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	48	#include "globals.h"
55 059a9e712aa7 Mit neuer Schnittstelle wieder lauff?hig. Florian Pose <fp@igh-essen.com> parents: 54 diff changeset	49	#include "slave.h"
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	50	#include "slave_config.h"
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	51	#include "device.h"
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	52	#include "datagram.h"
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	53	#ifdef EC_EOE
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	54	#include "ethernet.h"
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	55	#endif
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	56	#include "master.h"
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	57
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	58	/*****************************************************************************/
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	59
995 54149a703c47 Removed kobject from slave_config. Florian Pose <fp@igh-essen.com> parents: 994 diff changeset	60	void ec_master_clear_slave_configs(ec_master_t *);
993 8c32564252fd Removed kobject from domain. Florian Pose <fp@igh-essen.com> parents: 992 diff changeset	61	void ec_master_clear_domains(ec_master_t *);
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	62	static int ec_master_idle_thread(ec_master_t *);
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	63	static int ec_master_operation_thread(ec_master_t *);
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	64	#ifdef EC_EOE
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	65	void ec_master_eoe_run(unsigned long);
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	66	#endif
179 fb4c9dd11ca0 Sourced SysFS attribute show method prototypes out of headers. Florian Pose <fp@igh-essen.com> parents: 178 diff changeset	67
fb4c9dd11ca0 Sourced SysFS attribute show method prototypes out of headers. Florian Pose <fp@igh-essen.com> parents: 178 diff changeset	68	/*****************************************************************************/
fb4c9dd11ca0 Sourced SysFS attribute show method prototypes out of headers. Florian Pose <fp@igh-essen.com> parents: 178 diff changeset	69
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	70	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 191 diff changeset	71	Master constructor.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 191 diff changeset	72	\return 0 in case of success, else < 0
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 191 diff changeset	73	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 191 diff changeset	74
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 191 diff changeset	75	int ec_master_init(ec_master_t master, /< EtherCAT master /
576 158c5a3d0a2a New module file /sys/ethercat, masters moved to /sys/ethercat/masterX. Florian Pose <fp@igh-essen.com> parents: 573 diff changeset	76	unsigned int index, /*< master index /
639 aa23c48dca2d Allow only MAC addresses as device identifiers; replaced master list by Florian Pose <fp@igh-essen.com> parents: 637 diff changeset	77	const uint8_t main_mac, /< MAC address of main device /
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: 902 diff changeset	78	const uint8_t backup_mac, /< MAC address of backup device /
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: 902 diff changeset	79	dev_t device_number /*< Character device number. /
576 158c5a3d0a2a New module file /sys/ethercat, masters moved to /sys/ethercat/masterX. Florian Pose <fp@igh-essen.com> parents: 573 diff changeset	80	)
178 b84f69db8566 MERGE branches/sysfs -> trunk (whole SysFS implementation) Florian Pose <fp@igh-essen.com> parents: 176 diff changeset	81	{
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	82	unsigned int i;
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	83
178 b84f69db8566 MERGE branches/sysfs -> trunk (whole SysFS implementation) Florian Pose <fp@igh-essen.com> parents: 176 diff changeset	84	master->index = index;
647 dc556a8c8fed Replaced master variable 'atomic_t available' by integer and used Florian Pose <fp@igh-essen.com> parents: 646 diff changeset	85	master->reserved = 0;
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	86
639 aa23c48dca2d Allow only MAC addresses as device identifiers; replaced master list by Florian Pose <fp@igh-essen.com> parents: 637 diff changeset	87	master->main_mac = main_mac;
aa23c48dca2d Allow only MAC addresses as device identifiers; replaced master list by Florian Pose <fp@igh-essen.com> parents: 637 diff changeset	88	master->backup_mac = backup_mac;
381 006d3653701d Fixed race on duplicate device registering or device unregistering while requesting master. Florian Pose <fp@igh-essen.com> parents: 378 diff changeset	89	init_MUTEX(&master->device_sem);
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	90
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	91	master->mode = EC_MASTER_MODE_ORPHANED;
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	92	master->injection_seq_fsm = 0;
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	93	master->injection_seq_rt = 0;
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	94
182 8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 179 diff changeset	95	INIT_LIST_HEAD(&master->slaves);
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	96	master->slave_count = 0;
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	97
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	98	INIT_LIST_HEAD(&master->configs);
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	99
900 f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	100	master->scan_busy = 0;
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	101	master->allow_scan = 1;
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	102	init_MUTEX(&master->scan_sem);
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	103	init_waitqueue_head(&master->scan_queue);
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	104
900 f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	105	master->config_busy = 0;
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	106	master->allow_config = 1;
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	107	init_MUTEX(&master->config_sem);
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	108	init_waitqueue_head(&master->config_queue);
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	109
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	110	INIT_LIST_HEAD(&master->datagram_queue);
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	111	master->datagram_index = 0;
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	112
95 0066de7a456d Domains als Liste verwaltet. Florian Pose <fp@igh-essen.com> parents: 94 diff changeset	113	INIT_LIST_HEAD(&master->domains);
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	114
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	115	master->debug_level = 0;
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	116	master->stats.timeouts = 0;
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	117	master->stats.corrupted = 0;
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	118	master->stats.unmatched = 0;
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	119	master->stats.output_jiffies = 0;
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	120	master->frames_timed_out = 0;
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	121
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	122	for (i = 0; i < HZ; i++) {
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	123	master->idle_cycle_times[i] = 0;
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	124	#ifdef EC_EOE
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	125	master->eoe_cycle_times[i] = 0;
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	126	#endif
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	127	}
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	128	master->idle_cycle_time_pos = 0;
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	129	#ifdef EC_EOE
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	130	master->eoe_cycle_time_pos = 0;
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	131
226 07247920a7ba EoE with workqueue; bugfix in ec_master_init() Florian Pose <fp@igh-essen.com> parents: 214 diff changeset	132	init_timer(&master->eoe_timer);
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	133	master->eoe_timer.function = ec_master_eoe_run;
226 07247920a7ba EoE with workqueue; bugfix in ec_master_init() Florian Pose <fp@igh-essen.com> parents: 214 diff changeset	134	master->eoe_timer.data = (unsigned long) master;
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	135	master->eoe_running = 0;
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	136	INIT_LIST_HEAD(&master->eoe_handlers);
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	137	#endif
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	138
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	139	master->internal_lock = SPIN_LOCK_UNLOCKED;
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	140	master->request_cb = NULL;
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	141	master->release_cb = NULL;
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	142	master->cb_data = NULL;
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	143
872 d4e0380d63b3 Renamed EEPROM to SII. Florian Pose <fp@igh-essen.com> parents: 861 diff changeset	144	INIT_LIST_HEAD(&master->sii_requests);
d4e0380d63b3 Renamed EEPROM to SII. Florian Pose <fp@igh-essen.com> parents: 861 diff changeset	145	init_MUTEX(&master->sii_sem);
d4e0380d63b3 Renamed EEPROM to SII. Florian Pose <fp@igh-essen.com> parents: 861 diff changeset	146	init_waitqueue_head(&master->sii_queue);
601 d6d951b766e3 Introduced EEPROM write requests: EEPROM write operations from user Florian Pose <fp@igh-essen.com> parents: 597 diff changeset	147
849 4b712ec8929d Removed slave pointer from ec_sdo_request_t class. Florian Pose <fp@igh-essen.com> parents: 814 diff changeset	148	INIT_LIST_HEAD(&master->slave_sdo_requests);
441 ffa13db95e10 SDO uploading via Sysfs without master FSM calling wake_up(). Florian Pose <fp@igh-essen.com> parents: 435 diff changeset	149	init_MUTEX(&master->sdo_sem);
646 fbbd4e54e031 Implemented SDO reading with wait queues. Florian Pose <fp@igh-essen.com> parents: 643 diff changeset	150	init_waitqueue_head(&master->sdo_queue);
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	151
579 17c6fd3b076e Made master devices persistent; added ec_device_attach() and ec_device_detach(). Florian Pose <fp@igh-essen.com> parents: 578 diff changeset	152	// init devices
17c6fd3b076e Made master devices persistent; added ec_device_attach() and ec_device_detach(). Florian Pose <fp@igh-essen.com> parents: 578 diff changeset	153	if (ec_device_init(&master->main_device, master))
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	154	goto out_return;
579 17c6fd3b076e Made master devices persistent; added ec_device_attach() and ec_device_detach(). Florian Pose <fp@igh-essen.com> parents: 578 diff changeset	155
17c6fd3b076e Made master devices persistent; added ec_device_attach() and ec_device_detach(). Florian Pose <fp@igh-essen.com> parents: 578 diff changeset	156	if (ec_device_init(&master->backup_device, master))
17c6fd3b076e Made master devices persistent; added ec_device_attach() and ec_device_detach(). Florian Pose <fp@igh-essen.com> parents: 578 diff changeset	157	goto out_clear_main;
17c6fd3b076e Made master devices persistent; added ec_device_attach() and ec_device_detach(). Florian Pose <fp@igh-essen.com> parents: 578 diff changeset	158
528 f789bdd78b54 Layed out slave state machines in own files fsm_slave.[ch]; renamed fsm.[ch] to fsm_master.[ch] Florian Pose <fp@igh-essen.com> parents: 527 diff changeset	159	// init state machine datagram
f789bdd78b54 Layed out slave state machines in own files fsm_slave.[ch]; renamed fsm.[ch] to fsm_master.[ch] Florian Pose <fp@igh-essen.com> parents: 527 diff changeset	160	ec_datagram_init(&master->fsm_datagram);
719 03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 715 diff changeset	161	snprintf(master->fsm_datagram.name, EC_DATAGRAM_NAME_SIZE, "master-fsm");
528 f789bdd78b54 Layed out slave state machines in own files fsm_slave.[ch]; renamed fsm.[ch] to fsm_master.[ch] Florian Pose <fp@igh-essen.com> parents: 527 diff changeset	162	if (ec_datagram_prealloc(&master->fsm_datagram, EC_MAX_DATA_SIZE)) {
f789bdd78b54 Layed out slave state machines in own files fsm_slave.[ch]; renamed fsm.[ch] to fsm_master.[ch] Florian Pose <fp@igh-essen.com> parents: 527 diff changeset	163	EC_ERR("Failed to allocate FSM datagram.\n");
659 d7c5a958bad0 Removed unecessary clearing of EoE handlers in master init function; Florian Pose <fp@igh-essen.com> parents: 656 diff changeset	164	goto out_clear_backup;
528 f789bdd78b54 Layed out slave state machines in own files fsm_slave.[ch]; renamed fsm.[ch] to fsm_master.[ch] Florian Pose <fp@igh-essen.com> parents: 527 diff changeset	165	}
f789bdd78b54 Layed out slave state machines in own files fsm_slave.[ch]; renamed fsm.[ch] to fsm_master.[ch] Florian Pose <fp@igh-essen.com> parents: 527 diff changeset	166
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	167	// create state machine object
528 f789bdd78b54 Layed out slave state machines in own files fsm_slave.[ch]; renamed fsm.[ch] to fsm_master.[ch] Florian Pose <fp@igh-essen.com> parents: 527 diff changeset	168	ec_fsm_master_init(&master->fsm, master, &master->fsm_datagram);
226 07247920a7ba EoE with workqueue; bugfix in ec_master_init() Florian Pose <fp@igh-essen.com> parents: 214 diff changeset	169
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	170	// init character device
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	171	if (ec_cdev_init(&master->cdev, master, device_number))
659 d7c5a958bad0 Removed unecessary clearing of EoE handlers in master init function; Florian Pose <fp@igh-essen.com> parents: 656 diff changeset	172	goto out_clear_fsm;
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 140 diff changeset	173
178 b84f69db8566 MERGE branches/sysfs -> trunk (whole SysFS implementation) Florian Pose <fp@igh-essen.com> parents: 176 diff changeset	174	return 0;
226 07247920a7ba EoE with workqueue; bugfix in ec_master_init() Florian Pose <fp@igh-essen.com> parents: 214 diff changeset	175
659 d7c5a958bad0 Removed unecessary clearing of EoE handlers in master init function; Florian Pose <fp@igh-essen.com> parents: 656 diff changeset	176	out_clear_fsm:
d7c5a958bad0 Removed unecessary clearing of EoE handlers in master init function; Florian Pose <fp@igh-essen.com> parents: 656 diff changeset	177	ec_fsm_master_clear(&master->fsm);
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	178	ec_datagram_clear(&master->fsm_datagram);
659 d7c5a958bad0 Removed unecessary clearing of EoE handlers in master init function; Florian Pose <fp@igh-essen.com> parents: 656 diff changeset	179	out_clear_backup:
579 17c6fd3b076e Made master devices persistent; added ec_device_attach() and ec_device_detach(). Florian Pose <fp@igh-essen.com> parents: 578 diff changeset	180	ec_device_clear(&master->backup_device);
17c6fd3b076e Made master devices persistent; added ec_device_attach() and ec_device_detach(). Florian Pose <fp@igh-essen.com> parents: 578 diff changeset	181	out_clear_main:
17c6fd3b076e Made master devices persistent; added ec_device_attach() and ec_device_detach(). Florian Pose <fp@igh-essen.com> parents: 578 diff changeset	182	ec_device_clear(&master->main_device);
17c6fd3b076e Made master devices persistent; added ec_device_attach() and ec_device_detach(). Florian Pose <fp@igh-essen.com> parents: 578 diff changeset	183	out_return:
226 07247920a7ba EoE with workqueue; bugfix in ec_master_init() Florian Pose <fp@igh-essen.com> parents: 214 diff changeset	184	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	185	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	186
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	187	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	188
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	189	/** Destructor.
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 191 diff changeset	190	*/
639 aa23c48dca2d Allow only MAC addresses as device identifiers; replaced master list by Florian Pose <fp@igh-essen.com> parents: 637 diff changeset	191	void ec_master_clear(
aa23c48dca2d Allow only MAC addresses as device identifiers; replaced master list by Florian Pose <fp@igh-essen.com> parents: 637 diff changeset	192	ec_master_t master /< EtherCAT master /
aa23c48dca2d Allow only MAC addresses as device identifiers; replaced master list by Florian Pose <fp@igh-essen.com> parents: 637 diff changeset	193	)
aa23c48dca2d Allow only MAC addresses as device identifiers; replaced master list by Florian Pose <fp@igh-essen.com> parents: 637 diff changeset	194	{
995 54149a703c47 Removed kobject from slave_config. Florian Pose <fp@igh-essen.com> parents: 994 diff changeset	195	ec_cdev_clear(&master->cdev);
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	196	#ifdef EC_EOE
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	197	ec_master_clear_eoe_handlers(master);
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	198	#endif
994 e29edcced328 Clear domains before slave configs, because domain references the FMMU Florian Pose <fp@igh-essen.com> parents: 993 diff changeset	199	ec_master_clear_domains(master);
995 54149a703c47 Removed kobject from slave_config. Florian Pose <fp@igh-essen.com> parents: 994 diff changeset	200	ec_master_clear_slave_configs(master);
992 50a44cbd30af Removed kobjects from sdo and slave. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	201	ec_master_clear_slaves(master);
528 f789bdd78b54 Layed out slave state machines in own files fsm_slave.[ch]; renamed fsm.[ch] to fsm_master.[ch] Florian Pose <fp@igh-essen.com> parents: 527 diff changeset	202	ec_fsm_master_clear(&master->fsm);
f789bdd78b54 Layed out slave state machines in own files fsm_slave.[ch]; renamed fsm.[ch] to fsm_master.[ch] Florian Pose <fp@igh-essen.com> parents: 527 diff changeset	203	ec_datagram_clear(&master->fsm_datagram);
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	204	ec_device_clear(&master->backup_device);
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	205	ec_device_clear(&master->main_device);
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	206	}
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	207
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	208	/*****************************************************************************/
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	209
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	210	#ifdef EC_EOE
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	211	/** Clear and free all EoE handlers.
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	212	*/
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	213	void ec_master_clear_eoe_handlers(
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	214	ec_master_t master /< EtherCAT master /
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	215	)
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	216	{
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	217	ec_eoe_t eoe, next;
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	218
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	219	list_for_each_entry_safe(eoe, next, &master->eoe_handlers, list) {
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	220	list_del(&eoe->list);
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	221	ec_eoe_clear(eoe);
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	222	kfree(eoe);
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	223	}
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 68 diff changeset	224	}
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	225	#endif
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 68 diff changeset	226
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 68 diff changeset	227	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 68 diff changeset	228
995 54149a703c47 Removed kobject from slave_config. Florian Pose <fp@igh-essen.com> parents: 994 diff changeset	229	/** Clear all slave configurations.
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	230	*/
995 54149a703c47 Removed kobject from slave_config. Florian Pose <fp@igh-essen.com> parents: 994 diff changeset	231	void ec_master_clear_slave_configs(ec_master_t *master)
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	232	{
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	233	ec_slave_config_t sc, next;
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	234
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	235	list_for_each_entry_safe(sc, next, &master->configs, list) {
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	236	list_del(&sc->list);
995 54149a703c47 Removed kobject from slave_config. Florian Pose <fp@igh-essen.com> parents: 994 diff changeset	237	ec_slave_config_clear(sc);
54149a703c47 Removed kobject from slave_config. Florian Pose <fp@igh-essen.com> parents: 994 diff changeset	238	kfree(sc);
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	239	}
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	240	}
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	241
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	242	/*****************************************************************************/
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	243
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	244	/** Clear all slaves.
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	245	*/
992 50a44cbd30af Removed kobjects from sdo and slave. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	246	void ec_master_clear_slaves(ec_master_t *master)
238 b4960499098f Added finite state machine (FSM) processing. Florian Pose <fp@igh-essen.com> parents: 236 diff changeset	247	{
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	248	ec_slave_t slave, next;
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	249
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	250	list_for_each_entry_safe(slave, next, &master->slaves, list) {
238 b4960499098f Added finite state machine (FSM) processing. Florian Pose <fp@igh-essen.com> parents: 236 diff changeset	251	list_del(&slave->list);
992 50a44cbd30af Removed kobjects from sdo and slave. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	252	ec_slave_clear(slave);
50a44cbd30af Removed kobjects from sdo and slave. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	253	kfree(slave);
238 b4960499098f Added finite state machine (FSM) processing. Florian Pose <fp@igh-essen.com> parents: 236 diff changeset	254	}
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	255
238 b4960499098f Added finite state machine (FSM) processing. Florian Pose <fp@igh-essen.com> parents: 236 diff changeset	256	master->slave_count = 0;
74 9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	257	}
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	258
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	259	/*****************************************************************************/
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	260
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	261	/** Clear all domains.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	262	*/
993 8c32564252fd Removed kobject from domain. Florian Pose <fp@igh-essen.com> parents: 992 diff changeset	263	void ec_master_clear_domains(ec_master_t *master)
448 e4b76dc7910c FIX: Introduced destroy() functions for kobject-derived classes and thus fixed memory leak. Florian Pose <fp@igh-essen.com> parents: 446 diff changeset	264	{
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	265	ec_domain_t domain, next;
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	266
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	267	list_for_each_entry_safe(domain, next, &master->domains, list) {
448 e4b76dc7910c FIX: Introduced destroy() functions for kobject-derived classes and thus fixed memory leak. Florian Pose <fp@igh-essen.com> parents: 446 diff changeset	268	list_del(&domain->list);
993 8c32564252fd Removed kobject from domain. Florian Pose <fp@igh-essen.com> parents: 992 diff changeset	269	ec_domain_clear(domain);
8c32564252fd Removed kobject from domain. Florian Pose <fp@igh-essen.com> parents: 992 diff changeset	270	kfree(domain);
448 e4b76dc7910c FIX: Introduced destroy() functions for kobject-derived classes and thus fixed memory leak. Florian Pose <fp@igh-essen.com> parents: 446 diff changeset	271	}
e4b76dc7910c FIX: Introduced destroy() functions for kobject-derived classes and thus fixed memory leak. Florian Pose <fp@igh-essen.com> parents: 446 diff changeset	272	}
e4b76dc7910c FIX: Introduced destroy() functions for kobject-derived classes and thus fixed memory leak. Florian Pose <fp@igh-essen.com> parents: 446 diff changeset	273
e4b76dc7910c FIX: Introduced destroy() functions for kobject-derived classes and thus fixed memory leak. Florian Pose <fp@igh-essen.com> parents: 446 diff changeset	274	/*****************************************************************************/
e4b76dc7910c FIX: Introduced destroy() functions for kobject-derived classes and thus fixed memory leak. Florian Pose <fp@igh-essen.com> parents: 446 diff changeset	275
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	276	/** Internal locking callback.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	277	*/
515 37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	278	int ec_master_request_cb(void master /< callback data /)
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	279	{
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	280	spin_lock(&((ec_master_t *) master)->internal_lock);
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	281	return 0;
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	282	}
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	283
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	284	/*****************************************************************************/
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	285
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	286	/** Internal unlocking callback.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	287	*/
515 37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	288	void ec_master_release_cb(void master /< callback data /)
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	289	{
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	290	spin_unlock(&((ec_master_t *) master)->internal_lock);
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	291	}
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	292
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	293	/*****************************************************************************/
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	294
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	295	/** Starts the master thread.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	296	*/
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	297	int ec_master_thread_start(
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	298	ec_master_t master, /< EtherCAT master /
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	299	int (thread_func)(ec_master_t ) /*< thread function to start /
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	300	)
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	301	{
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	302	init_completion(&master->thread_exit);
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	303
540 a729667dea1e Minor changes in master thread messages. Florian Pose <fp@igh-essen.com> parents: 533 diff changeset	304	EC_INFO("Starting master thread.\n");
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	305	if (!(master->thread_id = kernel_thread((int ()(void )) thread_func,
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	306	master, CLONE_KERNEL)))
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	307	return -1;
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	308
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	309	return 0;
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	310	}
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	311
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	312	/*****************************************************************************/
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	313
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	314	/** Stops the master thread.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	315	*/
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	316	void ec_master_thread_stop(ec_master_t master /< EtherCAT master /)
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	317	{
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	318	if (!master->thread_id) {
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	319	EC_WARN("ec_master_thread_stop: Already finished!\n");
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	320	return;
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	321	}
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	322
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	323	kill_proc(master->thread_id, SIGTERM, 1);
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	324	wait_for_completion(&master->thread_exit);
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	325	EC_INFO("Master thread exited.\n");
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	326
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	327	if (master->fsm_datagram.state != EC_DATAGRAM_SENT) return;
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	328
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	329	// wait for FSM datagram
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	330	while (get_cycles() - master->fsm_datagram.cycles_sent
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	331	< (cycles_t) EC_IO_TIMEOUT /* us / (cpu_khz / 1000))
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	332	schedule();
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	333	}
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	334
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	335	/*****************************************************************************/
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	336
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	337	/** Transition function from ORPHANED to IDLE mode.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	338	*/
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	339	int ec_master_enter_idle_mode(ec_master_t master /< EtherCAT master /)
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	340	{
515 37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	341	master->request_cb = ec_master_request_cb;
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	342	master->release_cb = ec_master_release_cb;
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	343	master->cb_data = master;
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	344
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	345	master->mode = EC_MASTER_MODE_IDLE;
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	346	if (ec_master_thread_start(master, ec_master_idle_thread)) {
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	347	master->mode = EC_MASTER_MODE_ORPHANED;
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	348	return -1;
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	349	}
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	350
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	351	return 0;
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	352	}
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	353
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	354	/*****************************************************************************/
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	355
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	356	/** Transition function from IDLE to ORPHANED mode.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	357	*/
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	358	void ec_master_leave_idle_mode(ec_master_t master /< EtherCAT master /)
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	359	{
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	360	master->mode = EC_MASTER_MODE_ORPHANED;
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	361
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	362	#ifdef EC_EOE
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	363	ec_master_eoe_stop(master);
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	364	#endif
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	365	ec_master_thread_stop(master);
992 50a44cbd30af Removed kobjects from sdo and slave. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	366	ec_master_clear_slaves(master);
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	367	}
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	368
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	369	/*****************************************************************************/
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	370
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	371	/** Transition function from IDLE to OPERATION mode.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	372	*/
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	373	int ec_master_enter_operation_mode(ec_master_t master /< EtherCAT master /)
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	374	{
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	375	ec_slave_t *slave;
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	376	#ifdef EC_EOE
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	377	ec_eoe_t *eoe;
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	378	#endif
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	379
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	380	down(&master->config_sem);
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	381	master->allow_config = 0; // temporarily disable slave configuration
900 f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	382	if (master->config_busy) {
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	383	up(&master->config_sem);
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	384
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	385	// wait for slave configuration to complete
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	386	if (wait_event_interruptible(master->config_queue,
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	387	!master->config_busy)) {
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	388	EC_INFO("Finishing slave configuration interrupted by signal.\n");
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	389	goto out_allow;
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	390	}
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	391
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	392	if (master->debug_level)
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	393	EC_DBG("Waiting for pending slave configuration returned.\n");
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	394	} else {
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	395	up(&master->config_sem);
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	396	}
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	397
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	398	down(&master->scan_sem);
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	399	master->allow_scan = 0; // 'lock' the slave list
900 f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	400	if (!master->scan_busy) {
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	401	up(&master->scan_sem);
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	402	} else {
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	403	up(&master->scan_sem);
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	404
794 684dea874956 Allow bus configuration when link is down. Florian Pose <fp@igh-essen.com> parents: 792 diff changeset	405	// wait for slave scan to complete
900 f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	406	if (wait_event_interruptible(master->scan_queue, !master->scan_busy)) {
794 684dea874956 Allow bus configuration when link is down. Florian Pose <fp@igh-essen.com> parents: 792 diff changeset	407	EC_INFO("Waiting for slave scan interrupted by signal.\n");
684dea874956 Allow bus configuration when link is down. Florian Pose <fp@igh-essen.com> parents: 792 diff changeset	408	goto out_allow;
684dea874956 Allow bus configuration when link is down. Florian Pose <fp@igh-essen.com> parents: 792 diff changeset	409	}
900 f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	410
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	411	if (master->debug_level)
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	412	EC_DBG("Waiting for pending slave scan returned.\n");
f8b5c6d21705 Removed bus validation; slave configuration during realtime operation; Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	413	}
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	414
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	415	// set states for all slaves
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	416	list_for_each_entry(slave, &master->slaves, list) {
643 78929d878b2c Removed X:Y addressing scheme, ec_slave_is_coupler(), Florian Pose <fp@igh-essen.com> parents: 640 diff changeset	417	ec_slave_request_state(slave, EC_SLAVE_STATE_PREOP);
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	418	}
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	419	#ifdef EC_EOE
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	420	// ... but set EoE slaves to OP
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	421	list_for_each_entry(eoe, &master->eoe_handlers, list) {
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	422	if (ec_eoe_is_open(eoe))
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	423	ec_slave_request_state(eoe->slave, EC_SLAVE_STATE_OP);
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	424	}
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	425	#endif
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	426
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	427	if (master->debug_level)
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	428	EC_DBG("Switching to operation mode.\n");
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	429
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	430	master->mode = EC_MASTER_MODE_OPERATION;
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	431	master->ext_request_cb = NULL;
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	432	master->ext_release_cb = NULL;
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	433	master->ext_cb_data = NULL;
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	434	return 0;
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	435
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	436	out_allow:
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	437	master->allow_scan = 1;
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	438	master->allow_config = 1;
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	439	return -1;
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	440	}
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	441
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	442	/*****************************************************************************/
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	443
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	444	/** Transition function from OPERATION to IDLE mode.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	445	*/
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	446	void ec_master_leave_operation_mode(ec_master_t *master
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	447	/*< EtherCAT master /)
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	448	{
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	449	ec_slave_t *slave;
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	450	#ifdef EC_EOE
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	451	ec_eoe_t *eoe;
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	452	#endif
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	453
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	454	master->mode = EC_MASTER_MODE_IDLE;
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	455
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	456	#ifdef EC_EOE
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	457	ec_master_eoe_stop(master);
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	458	#endif
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	459	ec_master_thread_stop(master);
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	460
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	461	master->request_cb = ec_master_request_cb;
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	462	master->release_cb = ec_master_release_cb;
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	463	master->cb_data = master;
528 f789bdd78b54 Layed out slave state machines in own files fsm_slave.[ch]; renamed fsm.[ch] to fsm_master.[ch] Florian Pose <fp@igh-essen.com> parents: 527 diff changeset	464
993 8c32564252fd Removed kobject from domain. Florian Pose <fp@igh-essen.com> parents: 992 diff changeset	465	ec_master_clear_domains(master);
995 54149a703c47 Removed kobject from slave_config. Florian Pose <fp@igh-essen.com> parents: 994 diff changeset	466	ec_master_clear_slave_configs(master);
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	467
449 3caf8ff4d8a2 Moved functionality of ecrt_master_deactivate() (now deprecated) to ecrt_master_release(). Florian Pose <fp@igh-essen.com> parents: 448 diff changeset	468	// set states for all slaves
3caf8ff4d8a2 Moved functionality of ecrt_master_deactivate() (now deprecated) to ecrt_master_release(). Florian Pose <fp@igh-essen.com> parents: 448 diff changeset	469	list_for_each_entry(slave, &master->slaves, list) {
3caf8ff4d8a2 Moved functionality of ecrt_master_deactivate() (now deprecated) to ecrt_master_release(). Florian Pose <fp@igh-essen.com> parents: 448 diff changeset	470	ec_slave_request_state(slave, EC_SLAVE_STATE_PREOP);
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	471	}
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	472	#ifdef EC_EOE
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	473	// ... but leave EoE slaves in OP
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	474	list_for_each_entry(eoe, &master->eoe_handlers, list) {
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	475	if (ec_eoe_is_open(eoe))
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	476	ec_slave_request_state(eoe->slave, EC_SLAVE_STATE_OP);
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	477	}
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	478	#endif
448 e4b76dc7910c FIX: Introduced destroy() functions for kobject-derived classes and thus fixed memory leak. Florian Pose <fp@igh-essen.com> parents: 446 diff changeset	479
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	480	if (ec_master_thread_start(master, ec_master_idle_thread))
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	481	EC_WARN("Failed to restart master thread!\n");
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	482	#ifdef EC_EOE
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	483	ec_master_eoe_start(master);
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	484	#endif
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	485
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	486	master->allow_scan = 1;
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	487	master->allow_config = 1;
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	488	}
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	489
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	490	/*****************************************************************************/
8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 444 diff changeset	491
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	492	/** Places a datagram in the datagram queue.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	493	*/
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	494	void ec_master_queue_datagram(ec_master_t master, /< EtherCAT master /
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	495	ec_datagram_t datagram /< datagram /
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	496	)
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	497	{
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	498	ec_datagram_t *queued_datagram;
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	499
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	500	// check, if the datagram is already queued
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	501	list_for_each_entry(queued_datagram, &master->datagram_queue, queue) {
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	502	if (queued_datagram == datagram) {
719 03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 715 diff changeset	503	datagram->skip_count++;
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	504	if (master->debug_level)
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	505	EC_DBG("skipping datagram %x.\n", (unsigned int) datagram);
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 321 diff changeset	506	datagram->state = EC_DATAGRAM_QUEUED;
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	507	return;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	508	}
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	509	}
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	510
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	511	list_add_tail(&datagram->queue, &master->datagram_queue);
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 321 diff changeset	512	datagram->state = EC_DATAGRAM_QUEUED;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	513	}
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	514
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	515	/*****************************************************************************/
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	516
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	517	/** Sends the datagrams in the queue.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	518	*
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	519	* \return 0 in case of success, else < 0
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	520	*/
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	521	void ec_master_send_datagrams(ec_master_t master /< EtherCAT master /)
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	522	{
398 ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	523	ec_datagram_t datagram, next;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	524	size_t datagram_size;
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	525	uint8_t frame_data, cur_data;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	526	void *follows_word;
398 ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	527	cycles_t cycles_start, cycles_sent, cycles_end;
ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	528	unsigned long jiffies_sent;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	529	unsigned int frame_count, more_datagrams_waiting;
398 ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	530	struct list_head sent_datagrams;
ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	531
ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	532	cycles_start = get_cycles();
176 1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	533	frame_count = 0;
398 ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	534	INIT_LIST_HEAD(&sent_datagrams);
208 b7797f8a813d command timeout, EoE processing with kernel timer. Florian Pose <fp@igh-essen.com> parents: 206 diff changeset	535
303 03fd45bc13ef SysFS entry for debug level. Florian Pose <fp@igh-essen.com> parents: 298 diff changeset	536	if (unlikely(master->debug_level > 1))
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	537	EC_DBG("ec_master_send_datagrams\n");
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	538
176 1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	539	do {
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 191 diff changeset	540	// fetch pointer to transmit socket buffer
579 17c6fd3b076e Made master devices persistent; added ec_device_attach() and ec_device_detach(). Florian Pose <fp@igh-essen.com> parents: 578 diff changeset	541	frame_data = ec_device_tx_data(&master->main_device);
176 1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	542	cur_data = frame_data + EC_FRAME_HEADER_SIZE;
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	543	follows_word = NULL;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	544	more_datagrams_waiting = 0;
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	545
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	546	// fill current frame with datagrams
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	547	list_for_each_entry(datagram, &master->datagram_queue, queue) {
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 321 diff changeset	548	if (datagram->state != EC_DATAGRAM_QUEUED) continue;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	549
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	550	// does the current datagram fit in the frame?
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	551	datagram_size = EC_DATAGRAM_HEADER_SIZE + datagram->data_size
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	552	+ EC_DATAGRAM_FOOTER_SIZE;
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	553	if (cur_data - frame_data + datagram_size > ETH_DATA_LEN) {
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	554	more_datagrams_waiting = 1;
176 1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	555	break;
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	556	}
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	557
398 ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	558	list_add_tail(&datagram->sent, &sent_datagrams);
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	559	datagram->index = master->datagram_index++;
176 1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	560
303 03fd45bc13ef SysFS entry for debug level. Florian Pose <fp@igh-essen.com> parents: 298 diff changeset	561	if (unlikely(master->debug_level > 1))
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	562	EC_DBG("adding datagram 0x%02X\n", datagram->index);
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	563
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	564	// set "datagram following" flag in previous frame
176 1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	565	if (follows_word)
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	566	EC_WRITE_U16(follows_word, EC_READ_U16(follows_word) \| 0x8000);
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	567
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	568	// EtherCAT datagram header
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	569	EC_WRITE_U8 (cur_data, datagram->type);
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	570	EC_WRITE_U8 (cur_data + 1, datagram->index);
708 90bdb315f560 Fixed EtherCAT addressing problem on big-endian systems. The slaves Florian Pose <fp@igh-essen.com> parents: 697 diff changeset	571	memcpy(cur_data + 2, datagram->address, EC_ADDR_LEN);
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	572	EC_WRITE_U16(cur_data + 6, datagram->data_size & 0x7FF);
176 1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	573	EC_WRITE_U16(cur_data + 8, 0x0000);
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	574	follows_word = cur_data + 6;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	575	cur_data += EC_DATAGRAM_HEADER_SIZE;
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	576
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	577	// EtherCAT datagram data
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	578	memcpy(cur_data, datagram->data, datagram->data_size);
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	579	cur_data += datagram->data_size;
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	580
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	581	// EtherCAT datagram footer
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 191 diff changeset	582	EC_WRITE_U16(cur_data, 0x0000); // reset working counter
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	583	cur_data += EC_DATAGRAM_FOOTER_SIZE;
176 1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	584	}
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	585
398 ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	586	if (list_empty(&sent_datagrams)) {
303 03fd45bc13ef SysFS entry for debug level. Florian Pose <fp@igh-essen.com> parents: 298 diff changeset	587	if (unlikely(master->debug_level > 1))
176 1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	588	EC_DBG("nothing to send.\n");
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	589	break;
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	590	}
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	591
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	592	// EtherCAT frame header
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	593	EC_WRITE_U16(frame_data, ((cur_data - frame_data
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	594	- EC_FRAME_HEADER_SIZE) & 0x7FF) \| 0x1000);
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	595
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 191 diff changeset	596	// pad frame
211 c684b6b7adaf Using kernel Ethernet constants. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	597	while (cur_data - frame_data < ETH_ZLEN - ETH_HLEN)
176 1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	598	EC_WRITE_U8(cur_data++, 0x00);
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	599
303 03fd45bc13ef SysFS entry for debug level. Florian Pose <fp@igh-essen.com> parents: 298 diff changeset	600	if (unlikely(master->debug_level > 1))
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 958 diff changeset	601	EC_DBG("frame size: %u\n", cur_data - frame_data);
176 1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	602
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 191 diff changeset	603	// send frame
579 17c6fd3b076e Made master devices persistent; added ec_device_attach() and ec_device_detach(). Florian Pose <fp@igh-essen.com> parents: 578 diff changeset	604	ec_device_send(&master->main_device, cur_data - frame_data);
398 ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	605	cycles_sent = get_cycles();
ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	606	jiffies_sent = jiffies;
ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	607
ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	608	// set datagram states and sending timestamps
ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	609	list_for_each_entry_safe(datagram, next, &sent_datagrams, sent) {
ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	610	datagram->state = EC_DATAGRAM_SENT;
ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	611	datagram->cycles_sent = cycles_sent;
ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	612	datagram->jiffies_sent = jiffies_sent;
ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	613	list_del_init(&datagram->sent); // empty list of sent datagrams
ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	614	}
ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	615
176 1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	616	frame_count++;
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	617	}
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	618	while (more_datagrams_waiting);
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	619
303 03fd45bc13ef SysFS entry for debug level. Florian Pose <fp@igh-essen.com> parents: 298 diff changeset	620	if (unlikely(master->debug_level > 1)) {
344 5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 341 diff changeset	621	cycles_end = get_cycles();
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 958 diff changeset	622	EC_DBG("ec_master_send_datagrams sent %u frames in %uus.\n",
344 5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 341 diff changeset	623	frame_count,
5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 341 diff changeset	624	(unsigned int) (cycles_end - cycles_start) * 1000 / cpu_khz);
176 1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	625	}
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	626	}
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	627
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	628	/*****************************************************************************/
1ac0fc378b95 Sending of multiple frames Florian Pose <fp@igh-essen.com> parents: 173 diff changeset	629
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	630	/** Processes a received frame.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	631	*
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	632	* This function is called by the network driver for every received frame.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	633	*
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	634	* \return 0 in case of success, else < 0
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	635	*/
331 17f58fe99511 Renamed ec_master_receive() to ec_master_receive_datagrams(). Florian Pose <fp@igh-essen.com> parents: 330 diff changeset	636	void ec_master_receive_datagrams(ec_master_t master, /< EtherCAT master /
17f58fe99511 Renamed ec_master_receive() to ec_master_receive_datagrams(). Florian Pose <fp@igh-essen.com> parents: 330 diff changeset	637	const uint8_t frame_data, /< frame data /
17f58fe99511 Renamed ec_master_receive() to ec_master_receive_datagrams(). Florian Pose <fp@igh-essen.com> parents: 330 diff changeset	638	size_t size /*< size of the received data /
17f58fe99511 Renamed ec_master_receive() to ec_master_receive_datagrams(). Florian Pose <fp@igh-essen.com> parents: 330 diff changeset	639	)
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	640	{
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	641	size_t frame_size, data_size;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	642	uint8_t datagram_type, datagram_index;
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	643	unsigned int cmd_follows, matched;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	644	const uint8_t *cur_data;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	645	ec_datagram_t *datagram;
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	646
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	647	if (unlikely(size < EC_FRAME_HEADER_SIZE)) {
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	648	master->stats.corrupted++;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	649	ec_master_output_stats(master);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	650	return;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	651	}
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	652
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	653	cur_data = frame_data;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	654
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 191 diff changeset	655	// check length of entire frame
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	656	frame_size = EC_READ_U16(cur_data) & 0x07FF;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	657	cur_data += EC_FRAME_HEADER_SIZE;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	658
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	659	if (unlikely(frame_size > size)) {
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	660	master->stats.corrupted++;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	661	ec_master_output_stats(master);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	662	return;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	663	}
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	664
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	665	cmd_follows = 1;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	666	while (cmd_follows) {
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	667	// process datagram header
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	668	datagram_type = EC_READ_U8 (cur_data);
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	669	datagram_index = EC_READ_U8 (cur_data + 1);
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	670	data_size = EC_READ_U16(cur_data + 6) & 0x07FF;
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	671	cmd_follows = EC_READ_U16(cur_data + 6) & 0x8000;
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	672	cur_data += EC_DATAGRAM_HEADER_SIZE;
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	673
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	674	if (unlikely(cur_data - frame_data
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	675	+ data_size + EC_DATAGRAM_FOOTER_SIZE > size)) {
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	676	master->stats.corrupted++;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	677	ec_master_output_stats(master);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	678	return;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	679	}
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	680
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	681	// search for matching datagram in the queue
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	682	matched = 0;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	683	list_for_each_entry(datagram, &master->datagram_queue, queue) {
690 5e231f6a3d2e Re-ordered criteria for datagram matching. Florian Pose <fp@igh-essen.com> parents: 688 diff changeset	684	if (datagram->index == datagram_index
5e231f6a3d2e Re-ordered criteria for datagram matching. Florian Pose <fp@igh-essen.com> parents: 688 diff changeset	685	&& datagram->state == EC_DATAGRAM_SENT
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	686	&& datagram->type == datagram_type
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	687	&& datagram->data_size == data_size) {
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	688	matched = 1;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	689	break;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	690	}
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	691	}
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	692
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	693	// no matching datagram was found
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	694	if (!matched) {
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	695	master->stats.unmatched++;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	696	ec_master_output_stats(master);
684 bf991809dcf0 Added debugging output for unmatched frames and those that timed out. Florian Pose <fp@igh-essen.com> parents: 664 diff changeset	697
bf991809dcf0 Added debugging output for unmatched frames and those that timed out. Florian Pose <fp@igh-essen.com> parents: 664 diff changeset	698	if (unlikely(master->debug_level > 0)) {
bf991809dcf0 Added debugging output for unmatched frames and those that timed out. Florian Pose <fp@igh-essen.com> parents: 664 diff changeset	699	EC_DBG("UNMATCHED datagram:\n");
bf991809dcf0 Added debugging output for unmatched frames and those that timed out. Florian Pose <fp@igh-essen.com> parents: 664 diff changeset	700	ec_print_data(cur_data - EC_DATAGRAM_HEADER_SIZE,
bf991809dcf0 Added debugging output for unmatched frames and those that timed out. Florian Pose <fp@igh-essen.com> parents: 664 diff changeset	701	EC_DATAGRAM_HEADER_SIZE + data_size
bf991809dcf0 Added debugging output for unmatched frames and those that timed out. Florian Pose <fp@igh-essen.com> parents: 664 diff changeset	702	+ EC_DATAGRAM_FOOTER_SIZE);
692 fe7cf37c33f1 Implemented debug frame ring to output the last n frames for debugging Florian Pose <fp@igh-essen.com> parents: 691 diff changeset	703	#ifdef EC_DEBUG_RING
fe7cf37c33f1 Implemented debug frame ring to output the last n frames for debugging Florian Pose <fp@igh-essen.com> parents: 691 diff changeset	704	ec_device_debug_ring_print(&master->main_device);
fe7cf37c33f1 Implemented debug frame ring to output the last n frames for debugging Florian Pose <fp@igh-essen.com> parents: 691 diff changeset	705	#endif
684 bf991809dcf0 Added debugging output for unmatched frames and those that timed out. Florian Pose <fp@igh-essen.com> parents: 664 diff changeset	706	}
bf991809dcf0 Added debugging output for unmatched frames and those that timed out. Florian Pose <fp@igh-essen.com> parents: 664 diff changeset	707
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	708	cur_data += data_size + EC_DATAGRAM_FOOTER_SIZE;
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	709	continue;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	710	}
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	711
345 beb0a77d73c0 Improved datagram reception in sync_io and frame dequeuing. Florian Pose <fp@igh-essen.com> parents: 344 diff changeset	712	// copy received data into the datagram memory
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	713	memcpy(datagram->data, cur_data, data_size);
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	714	cur_data += data_size;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	715
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	716	// set the datagram's working counter
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	717	datagram->working_counter = EC_READ_U16(cur_data);
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	718	cur_data += EC_DATAGRAM_FOOTER_SIZE;
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	719
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	720	// dequeue the received datagram
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 321 diff changeset	721	datagram->state = EC_DATAGRAM_RECEIVED;
579 17c6fd3b076e Made master devices persistent; added ec_device_attach() and ec_device_detach(). Florian Pose <fp@igh-essen.com> parents: 578 diff changeset	722	datagram->cycles_received = master->main_device.cycles_poll;
17c6fd3b076e Made master devices persistent; added ec_device_attach() and ec_device_detach(). Florian Pose <fp@igh-essen.com> parents: 578 diff changeset	723	datagram->jiffies_received = master->main_device.jiffies_poll;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	724	list_del_init(&datagram->queue);
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	725	}
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	726	}
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	727
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	728	/*****************************************************************************/
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 291 diff changeset	729
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	730	/** Output statistics in cyclic mode.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	731	*
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	732	* This function outputs statistical data on demand, but not more often than
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	733	* necessary. The output happens at most once a second.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	734	*/
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 191 diff changeset	735	void ec_master_output_stats(ec_master_t master /< EtherCAT master /)
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	736	{
344 5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 341 diff changeset	737	if (unlikely(jiffies - master->stats.output_jiffies >= HZ)) {
5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 341 diff changeset	738	master->stats.output_jiffies = jiffies;
5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 341 diff changeset	739
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	740	if (master->stats.timeouts) {
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 958 diff changeset	741	EC_WARN("%u datagram%s TIMED OUT!\n", master->stats.timeouts,
396 189909f92019 Minor output changes. Florian Pose <fp@igh-essen.com> parents: 382 diff changeset	742	master->stats.timeouts == 1 ? "" : "s");
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	743	master->stats.timeouts = 0;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	744	}
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	745	if (master->stats.corrupted) {
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 958 diff changeset	746	EC_WARN("%u frame%s CORRUPTED!\n", master->stats.corrupted,
396 189909f92019 Minor output changes. Florian Pose <fp@igh-essen.com> parents: 382 diff changeset	747	master->stats.corrupted == 1 ? "" : "s");
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	748	master->stats.corrupted = 0;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	749	}
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	750	if (master->stats.unmatched) {
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 958 diff changeset	751	EC_WARN("%u datagram%s UNMATCHED!\n", master->stats.unmatched,
396 189909f92019 Minor output changes. Florian Pose <fp@igh-essen.com> parents: 382 diff changeset	752	master->stats.unmatched == 1 ? "" : "s");
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	753	master->stats.unmatched = 0;
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 95 diff changeset	754	}
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 68 diff changeset	755	}
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	756	}
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	757
68 a452700db994 Neue ASCII-Adressierung und Code-Dokumantation. Florian Pose <fp@igh-essen.com> parents: 66 diff changeset	758	/*****************************************************************************/
a452700db994 Neue ASCII-Adressierung und Code-Dokumantation. Florian Pose <fp@igh-essen.com> parents: 66 diff changeset	759
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	760	/** Master kernel thread function for IDLE mode.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	761	*/
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	762	static int ec_master_idle_thread(ec_master_t *master)
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	763	{
344 5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 341 diff changeset	764	cycles_t cycles_start, cycles_end;
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	765
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	766	daemonize("EtherCAT-IDLE");
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	767	allow_signal(SIGTERM);
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	768
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	769	while (!signal_pending(current)) {
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	770	cycles_start = get_cycles();
719 03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 715 diff changeset	771	ec_datagram_output_stats(&master->fsm_datagram);
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	772
691 77b79a29e0e7 Included datagram queuing in critical section in idle task; added some Florian Pose <fp@igh-essen.com> parents: 690 diff changeset	773	if (ec_fsm_master_running(&master->fsm)) { // datagram on the way
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	774	// receive
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	775	spin_lock_bh(&master->internal_lock);
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	776	ecrt_master_receive(master);
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	777	spin_unlock_bh(&master->internal_lock);
691 77b79a29e0e7 Included datagram queuing in critical section in idle task; added some Florian Pose <fp@igh-essen.com> parents: 690 diff changeset	778
77b79a29e0e7 Included datagram queuing in critical section in idle task; added some Florian Pose <fp@igh-essen.com> parents: 690 diff changeset	779	if (master->fsm_datagram.state == EC_DATAGRAM_SENT)
77b79a29e0e7 Included datagram queuing in critical section in idle task; added some Florian Pose <fp@igh-essen.com> parents: 690 diff changeset	780	goto schedule;
77b79a29e0e7 Included datagram queuing in critical section in idle task; added some Florian Pose <fp@igh-essen.com> parents: 690 diff changeset	781	}
651 8c11399cc911 Fixed skipped datagrams when not in FSM idle phase. Florian Pose <fp@igh-essen.com> parents: 650 diff changeset	782
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	783	// execute master state machine
691 77b79a29e0e7 Included datagram queuing in critical section in idle task; added some Florian Pose <fp@igh-essen.com> parents: 690 diff changeset	784	if (ec_fsm_master_exec(&master->fsm)) { // datagram ready for sending
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	785	// queue and send
691 77b79a29e0e7 Included datagram queuing in critical section in idle task; added some Florian Pose <fp@igh-essen.com> parents: 690 diff changeset	786	spin_lock_bh(&master->internal_lock);
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	787	ec_master_queue_datagram(master, &master->fsm_datagram);
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	788	ecrt_master_send(master);
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	789	spin_unlock_bh(&master->internal_lock);
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	790	}
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	791
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	792	cycles_end = get_cycles();
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	793	master->idle_cycle_times[master->idle_cycle_time_pos]
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	794	= (u32) (cycles_end - cycles_start) * 1000 / cpu_khz;
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	795	master->idle_cycle_time_pos++;
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	796	master->idle_cycle_time_pos %= HZ;
8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	797
651 8c11399cc911 Fixed skipped datagrams when not in FSM idle phase. Florian Pose <fp@igh-essen.com> parents: 650 diff changeset	798	schedule:
650 c68995623e94 Introduced idle flag in master state machine. Florian Pose <fp@igh-essen.com> parents: 648 diff changeset	799	if (ec_fsm_master_idle(&master->fsm)) {
c68995623e94 Introduced idle flag in master state machine. Florian Pose <fp@igh-essen.com> parents: 648 diff changeset	800	set_current_state(TASK_INTERRUPTIBLE);
c68995623e94 Introduced idle flag in master state machine. Florian Pose <fp@igh-essen.com> parents: 648 diff changeset	801	schedule_timeout(1);
c68995623e94 Introduced idle flag in master state machine. Florian Pose <fp@igh-essen.com> parents: 648 diff changeset	802	}
c68995623e94 Introduced idle flag in master state machine. Florian Pose <fp@igh-essen.com> parents: 648 diff changeset	803	else {
c68995623e94 Introduced idle flag in master state machine. Florian Pose <fp@igh-essen.com> parents: 648 diff changeset	804	schedule();
c68995623e94 Introduced idle flag in master state machine. Florian Pose <fp@igh-essen.com> parents: 648 diff changeset	805	}
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	806	}
518 b6a1426ba724 Fixed race: Stop EoE processing when entering or leaving operation mode. Florian Pose <fp@igh-essen.com> parents: 517 diff changeset	807
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	808	master->thread_id = 0;
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	809	if (master->debug_level)
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	810	EC_DBG("Master IDLE thread exiting...\n");
525 8b20781bd1e0 Master workqueue replaced with kernel thread. Florian Pose <fp@igh-essen.com> parents: 524 diff changeset	811	complete_and_exit(&master->thread_exit, 0);
191 ca805255a935 Prepared Free-Run mode Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	812	}
ca805255a935 Prepared Free-Run mode Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	813
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	814	/*****************************************************************************/
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	815
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	816	/** Master kernel thread function for IDLE mode.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	817	*/
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	818	static int ec_master_operation_thread(ec_master_t *master)
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	819	{
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	820	cycles_t cycles_start, cycles_end;
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	821
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	822	daemonize("EtherCAT-OP");
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	823	allow_signal(SIGTERM);
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	824
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	825	while (!signal_pending(current)) {
719 03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 715 diff changeset	826	ec_datagram_output_stats(&master->fsm_datagram);
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	827	if (master->injection_seq_rt != master->injection_seq_fsm \|\|
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	828	master->fsm_datagram.state == EC_DATAGRAM_SENT \|\|
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	829	master->fsm_datagram.state == EC_DATAGRAM_QUEUED)
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	830	goto schedule;
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	831
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	832	cycles_start = get_cycles();
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	833
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	834	// output statistics
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	835	ec_master_output_stats(master);
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	836
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	837	// execute master state machine
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	838	if (ec_fsm_master_exec(&master->fsm)) {
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	839	// inject datagram
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	840	master->injection_seq_fsm++;
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	841	}
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	842
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	843	cycles_end = get_cycles();
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	844	master->idle_cycle_times[master->idle_cycle_time_pos]
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	845	= (u32) (cycles_end - cycles_start) * 1000 / cpu_khz;
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	846	master->idle_cycle_time_pos++;
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	847	master->idle_cycle_time_pos %= HZ;
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	848
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	849	schedule:
650 c68995623e94 Introduced idle flag in master state machine. Florian Pose <fp@igh-essen.com> parents: 648 diff changeset	850	if (ec_fsm_master_idle(&master->fsm)) {
c68995623e94 Introduced idle flag in master state machine. Florian Pose <fp@igh-essen.com> parents: 648 diff changeset	851	set_current_state(TASK_INTERRUPTIBLE);
c68995623e94 Introduced idle flag in master state machine. Florian Pose <fp@igh-essen.com> parents: 648 diff changeset	852	schedule_timeout(1);
c68995623e94 Introduced idle flag in master state machine. Florian Pose <fp@igh-essen.com> parents: 648 diff changeset	853	}
c68995623e94 Introduced idle flag in master state machine. Florian Pose <fp@igh-essen.com> parents: 648 diff changeset	854	else {
c68995623e94 Introduced idle flag in master state machine. Florian Pose <fp@igh-essen.com> parents: 648 diff changeset	855	schedule();
c68995623e94 Introduced idle flag in master state machine. Florian Pose <fp@igh-essen.com> parents: 648 diff changeset	856	}
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	857	}
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	858
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	859	master->thread_id = 0;
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	860	if (master->debug_level)
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	861	EC_DBG("Master OP thread exiting...\n");
637 d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	862	complete_and_exit(&master->thread_exit, 0);
d5d04c868e0e Removed ecrt_master_run(), removed datagram queueing from state Florian Pose <fp@igh-essen.com> parents: 612 diff changeset	863	}
578 f402b4bd2f4d Removed ktype for module kobject; added backup device for master; device Florian Pose <fp@igh-essen.com> parents: 576 diff changeset	864
f402b4bd2f4d Removed ktype for module kobject; added backup device for master; device Florian Pose <fp@igh-essen.com> parents: 576 diff changeset	865	/*****************************************************************************/
f402b4bd2f4d Removed ktype for module kobject; added backup device for master; device Florian Pose <fp@igh-essen.com> parents: 576 diff changeset	866
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	867	#ifdef EC_EOE
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	868	/** Starts Ethernet-over-EtherCAT processing on demand.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	869	*/
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	870	void ec_master_eoe_start(ec_master_t master /< EtherCAT master /)
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	871	{
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	872	if (master->eoe_running) {
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	873	EC_WARN("EoE already running!\n");
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	874	return;
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	875	}
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	876
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	877	if (list_empty(&master->eoe_handlers))
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	878	return;
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	879
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	880	if (!master->request_cb \|\| !master->release_cb) {
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	881	EC_WARN("No EoE processing because of missing locking callbacks!\n");
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	882	return;
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	883	}
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	884
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	885	EC_INFO("Starting EoE processing.\n");
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	886	master->eoe_running = 1;
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	887
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	888	// start EoE processing
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	889	master->eoe_timer.expires = jiffies + 10;
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	890	add_timer(&master->eoe_timer);
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	891	}
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	892
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	893	/*****************************************************************************/
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	894
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	895	/** Stops the Ethernet-over-EtherCAT processing.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	896	*/
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	897	void ec_master_eoe_stop(ec_master_t master /< EtherCAT master /)
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	898	{
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	899	if (!master->eoe_running) return;
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	900
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	901	EC_INFO("Stopping EoE processing.\n");
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	902
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	903	del_timer_sync(&master->eoe_timer);
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	904	master->eoe_running = 0;
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	905	}
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	906
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	907	/*****************************************************************************/
441 ffa13db95e10 SDO uploading via Sysfs without master FSM calling wake_up(). Florian Pose <fp@igh-essen.com> parents: 435 diff changeset	908
997 652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	909	/** Does the Ethernet-over-EtherCAT processing.
652180478e95 Removed kobject from master and module. Sysfs is gone! Florian Pose <fp@igh-essen.com> parents: 995 diff changeset	910	*/
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	911	void ec_master_eoe_run(unsigned long data /*< master pointer /)
206 60a10d85c20b Prepared EoE processing with workqueue. Florian Pose <fp@igh-essen.com> parents: 204 diff changeset	912	{
60a10d85c20b Prepared EoE processing with workqueue. Florian Pose <fp@igh-essen.com> parents: 204 diff changeset	913	ec_master_t master = (ec_master_t ) data;
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	914	ec_eoe_t *eoe;
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	915	unsigned int none_open = 1;
344 5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 341 diff changeset	916	cycles_t cycles_start, cycles_end;
5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 341 diff changeset	917	unsigned long restart_jiffies;
235 f973808540a6 No master locking, if no EoE devices are "up". Florian Pose <fp@igh-essen.com> parents: 228 diff changeset	918
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	919	list_for_each_entry(eoe, &master->eoe_handlers, list) {
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	920	if (ec_eoe_is_open(eoe)) {
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	921	none_open = 0;
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	922	break;
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	923	}
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	924	}
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	925	if (none_open)
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	926	goto queue_timer;
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	927
721 ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock Florian Pose <fp@igh-essen.com> parents: 720 diff changeset	928	// receive datagrams
663 38d9c37664d9 Completely lock master while an EoE cycle is executing. Florian Pose <fp@igh-essen.com> parents: 661 diff changeset	929	if (master->request_cb(master->cb_data)) goto queue_timer;
344 5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 341 diff changeset	930	cycles_start = get_cycles();
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 321 diff changeset	931	ecrt_master_receive(master);
721 ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock Florian Pose <fp@igh-essen.com> parents: 720 diff changeset	932	master->release_cb(master->cb_data);
515 37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	933
37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	934	// actual EoE processing
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	935	list_for_each_entry(eoe, &master->eoe_handlers, list) {
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	936	ec_eoe_run(eoe);
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	937	}
334 2be97e069602 Master information, timing. Florian Pose <fp@igh-essen.com> parents: 332 diff changeset	938
515 37aa1bfa0dee Internal locking callbacks, improved locking. Florian Pose <fp@igh-essen.com> parents: 511 diff changeset	939	// send datagrams
721 ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock Florian Pose <fp@igh-essen.com> parents: 720 diff changeset	940	if (master->request_cb(master->cb_data)) {
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock Florian Pose <fp@igh-essen.com> parents: 720 diff changeset	941	goto queue_timer;
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock Florian Pose <fp@igh-essen.com> parents: 720 diff changeset	942	}
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock Florian Pose <fp@igh-essen.com> parents: 720 diff changeset	943	list_for_each_entry(eoe, &master->eoe_handlers, list) {
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock Florian Pose <fp@igh-essen.com> parents: 720 diff changeset	944	ec_eoe_queue(eoe);
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock Florian Pose <fp@igh-essen.com> parents: 720 diff changeset	945	}
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 321 diff changeset	946	ecrt_master_send(master);
721 ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock Florian Pose <fp@igh-essen.com> parents: 720 diff changeset	947	master->release_cb(master->cb_data);
344 5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 341 diff changeset	948	cycles_end = get_cycles();
663 38d9c37664d9 Completely lock master while an EoE cycle is executing. Florian Pose <fp@igh-essen.com> parents: 661 diff changeset	949
335 1e37c856b74e Better EoE and Idle timing measurement. Florian Pose <fp@igh-essen.com> parents: 334 diff changeset	950	master->eoe_cycle_times[master->eoe_cycle_time_pos]
344 5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 341 diff changeset	951	= (u32) (cycles_end - cycles_start) * 1000 / cpu_khz;
335 1e37c856b74e Better EoE and Idle timing measurement. Florian Pose <fp@igh-essen.com> parents: 334 diff changeset	952	master->eoe_cycle_time_pos++;
1e37c856b74e Better EoE and Idle timing measurement. Florian Pose <fp@igh-essen.com> parents: 334 diff changeset	953	master->eoe_cycle_time_pos %= HZ;
334 2be97e069602 Master information, timing. Florian Pose <fp@igh-essen.com> parents: 332 diff changeset	954
251 c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	955	queue_timer:
344 5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 341 diff changeset	956	restart_jiffies = HZ / EC_EOE_FREQUENCY;
5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 341 diff changeset	957	if (!restart_jiffies) restart_jiffies = 1;
721 ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock Florian Pose <fp@igh-essen.com> parents: 720 diff changeset	958	master->eoe_timer.expires = jiffies + restart_jiffies;
208 b7797f8a813d command timeout, EoE processing with kernel timer. Florian Pose <fp@igh-essen.com> parents: 206 diff changeset	959	add_timer(&master->eoe_timer);
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	960	}
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	961	#endif
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	962
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 321 diff changeset	963	/*****************************************************************************/
7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 321 diff changeset	964
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	965	/** Detaches the slave configurations from the slaves.
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	966	*/
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	967	void ec_master_detach_slave_configs(
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	968	ec_master_t master /< EtherCAT master. /
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	969	)
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	970	{
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	971	ec_slave_config_t *sc;
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	972
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	973	if (!master->configs_attached)
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	974	return;
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	975
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	976	list_for_each_entry(sc, &master->configs, list) {
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	977	ec_slave_config_detach(sc);
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	978	}
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	979
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	980	master->configs_attached = 0;
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	981	}
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	982
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	983	/*****************************************************************************/
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	984
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	985	/** Attaches the slave configurations to the slaves.
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	986	*/
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	987	int ec_master_attach_slave_configs(
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	988	ec_master_t master /< EtherCAT master. /
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	989	)
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	990	{
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	991	ec_slave_config_t *sc;
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	992	unsigned int errors = 0;
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	993
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	994	if (master->configs_attached)
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	995	return 0;
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	996
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	997	list_for_each_entry(sc, &master->configs, list) {
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	998	if (ec_slave_config_attach(sc))
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	999	errors = 1;
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1000	}
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1001
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1002	master->configs_attached = !errors;
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1003	return errors ? -1 : 0;
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	1004	}
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	1005
927 ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1006	/*****************************************************************************/
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1007
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1008	/** Finds a slave in the bus, given the alias and position.
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1009	*/
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1010	ec_slave_t *ec_master_find_slave(
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1011	ec_master_t master, /< EtherCAT master. /
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1012	uint16_t alias, /*< Slave alias. /
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1013	uint16_t position /*< Slave position. /
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1014	)
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1015	{
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1016	ec_slave_t *slave;
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1017	unsigned int alias_found = 0, relative_position = 0;
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1018
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1019	list_for_each_entry(slave, &master->slaves, list) {
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1020	if (!alias_found) {
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1021	if (alias && slave->sii.alias != alias)
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1022	continue;
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1023	alias_found = 1;
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1024	relative_position = 0;
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1025	}
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1026	if (relative_position == position) {
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1027	return slave;
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1028	}
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1029	relative_position++;
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1030	}
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1031
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1032	return NULL;
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1033	}
ffb7d1876ce0 Introduced ec_master_find_slave(). Florian Pose <fp@igh-essen.com> parents: 926 diff changeset	1034
946 6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1035	/*****************************************************************************/
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1036
990 4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1037	unsigned int ec_master_config_count(
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1038	const ec_master_t master /< EtherCAT master. /
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1039	)
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1040	{
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1041	const ec_slave_config_t *sc;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1042	unsigned int count = 0;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1043
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1044	list_for_each_entry(sc, &master->configs, list) {
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1045	count++;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1046	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1047
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1048	return count;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1049	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1050
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1051	/*****************************************************************************/
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1052
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1053	const ec_slave_config_t *ec_master_get_config_const(
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1054	const ec_master_t master, /< EtherCAT master. /
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1055	unsigned int index /*< List position. /
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1056	)
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1057	{
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1058	const ec_slave_config_t *sc;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1059
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1060	list_for_each_entry(sc, &master->configs, list) {
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1061	if (index--)
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1062	continue;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1063	return sc;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1064	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1065
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1066	return NULL;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1067	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1068
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1069	/*****************************************************************************/
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	1070
946 6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1071	unsigned int ec_master_domain_count(
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1072	const ec_master_t master /< EtherCAT master. /
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1073	)
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1074	{
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1075	const ec_domain_t *domain;
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1076	unsigned int count = 0;
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1077
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1078	list_for_each_entry(domain, &master->domains, list) {
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1079	count++;
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1080	}
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1081
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1082	return count;
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1083	}
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1084
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1085	/*****************************************************************************/
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1086
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1087	ec_domain_t *ec_master_find_domain(
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1088	ec_master_t master, /< EtherCAT master. /
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1089	unsigned int index /*< Domain index. /
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1090	)
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1091	{
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1092	ec_domain_t *domain;
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1093
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1094	list_for_each_entry(domain, &master->domains, list) {
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1095	if (index--)
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1096	continue;
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1097	return domain;
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1098	}
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1099
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1100	return NULL;
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1101	}
6ef20c5de875 Introduced ec_master_domain_count() and ec_master_find_domain(). Florian Pose <fp@igh-essen.com> parents: 927 diff changeset	1102
956 d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1103	/*****************************************************************************/
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1104
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1105	int ec_master_debug_level(
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1106	ec_master_t *master,
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1107	int level
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1108	)
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1109	{
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1110	if (level < 0 \|\| level > 2) {
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1111	EC_ERR("Invalid debug level %i!\n", level);
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1112	return -1;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1113	}
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1114
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1115	if (level != master->debug_level) {
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1116	master->debug_level = level;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1117	EC_INFO("Master debug level set to %i.\n", master->debug_level);
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1118	}
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1119
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1120	return 0;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1121	}
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 946 diff changeset	1122
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1123	/******************************************************************************
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1124	* Realtime interface
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1125	*****************************************************************************/
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1126
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1127	ec_domain_t ecrt_master_create_domain(ec_master_t master /*< master /)
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1128	{
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1129	ec_domain_t domain, last_domain;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1130	unsigned int index;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1131
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1132	if (!(domain = (ec_domain_t *) kmalloc(sizeof(ec_domain_t), GFP_KERNEL))) {
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1133	EC_ERR("Error allocating domain memory!\n");
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1134	return NULL;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1135	}
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1136
993 8c32564252fd Removed kobject from domain. Florian Pose <fp@igh-essen.com> parents: 992 diff changeset	1137	if (list_empty(&master->domains)) {
8c32564252fd Removed kobject from domain. Florian Pose <fp@igh-essen.com> parents: 992 diff changeset	1138	index = 0;
8c32564252fd Removed kobject from domain. Florian Pose <fp@igh-essen.com> parents: 992 diff changeset	1139	} else {
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1140	last_domain = list_entry(master->domains.prev, ec_domain_t, list);
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1141	index = last_domain->index + 1;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1142	}
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1143
993 8c32564252fd Removed kobject from domain. Florian Pose <fp@igh-essen.com> parents: 992 diff changeset	1144	ec_domain_init(domain, master, index);
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1145	list_add_tail(&domain->list, &master->domains);
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1146
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1147	return domain;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1148	}
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1149
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1150	/*****************************************************************************/
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1151
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1152	int ecrt_master_activate(ec_master_t *master)
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1153	{
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1154	uint32_t domain_offset;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1155	ec_domain_t *domain;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1156
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1157	// finish all domains
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1158	domain_offset = 0;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1159	list_for_each_entry(domain, &master->domains, list) {
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1160	if (ec_domain_finish(domain, domain_offset)) {
926 6bb33c6ec770 Output subindices with %02X. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1161	EC_ERR("Failed to finish domain 0x%08X!\n", (u32) domain);
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1162	return -1;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1163	}
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1164	domain_offset += domain->data_size;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1165	}
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1166
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	1167	// restart EoE process and master thread with new locking
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	1168	#ifdef EC_EOE
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	1169	ec_master_eoe_stop(master);
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	1170	#endif
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	1171	ec_master_thread_stop(master);
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	1172
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1173	if (master->debug_level)
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1174	EC_DBG("FSM datagram is %x.\n", (unsigned int) &master->fsm_datagram);
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1175
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	1176	master->injection_seq_fsm = 0;
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	1177	master->injection_seq_rt = 0;
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	1178	master->request_cb = master->ext_request_cb;
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	1179	master->release_cb = master->ext_release_cb;
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	1180	master->cb_data = master->ext_cb_data;
656 370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	1181
370aa8c2d1b1 Slave configuration exclusively from master thread; removed Florian Pose <fp@igh-essen.com> parents: 651 diff changeset	1182	if (ec_master_thread_start(master, ec_master_operation_thread)) {
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1183	EC_ERR("Failed to start master thread!\n");
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1184	return -1;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1185	}
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	1186	#ifdef EC_EOE
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	1187	ec_master_eoe_start(master);
715 f12ff7c08623 Added --enable-eoe conditional. Florian Pose <fp@igh-essen.com> parents: 714 diff changeset	1188	#endif
902 ad703091a32b Moved setting of the allow flags. Florian Pose <fp@igh-essen.com> parents: 901 diff changeset	1189
ad703091a32b Moved setting of the allow flags. Florian Pose <fp@igh-essen.com> parents: 901 diff changeset	1190	master->allow_config = 1; // request the current configuration
ad703091a32b Moved setting of the allow flags. Florian Pose <fp@igh-essen.com> parents: 901 diff changeset	1191	master->allow_scan = 1; // allow re-scanning on topology change
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1192	return 0;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1193	}
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1194
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1195	/*****************************************************************************/
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1196
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1197	void ecrt_master_send(ec_master_t *master)
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1198	{
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1199	ec_datagram_t datagram, n;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1200
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1201	if (master->injection_seq_rt != master->injection_seq_fsm) {
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1202	// inject datagram produced by master FSM
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1203	ec_master_queue_datagram(master, &master->fsm_datagram);
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1204	master->injection_seq_rt = master->injection_seq_fsm;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1205	}
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1206
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1207	if (unlikely(!master->main_device.link_state)) {
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1208	// link is down, no datagram can be sent
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1209	list_for_each_entry_safe(datagram, n, &master->datagram_queue, queue) {
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1210	datagram->state = EC_DATAGRAM_ERROR;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1211	list_del_init(&datagram->queue);
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1212	}
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1213
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1214	// query link state
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1215	ec_device_poll(&master->main_device);
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1216	return;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1217	}
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1218
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1219	// send frames
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1220	ec_master_send_datagrams(master);
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1221	}
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1222
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1223	/*****************************************************************************/
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1224
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1225	void ecrt_master_receive(ec_master_t *master)
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1226	{
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1227	ec_datagram_t datagram, next;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1228	cycles_t cycles_timeout;
664 18c48cb7de06 Introduced frames_timed_out flag to notice bus failure when link down is Florian Pose <fp@igh-essen.com> parents: 663 diff changeset	1229	unsigned int frames_timed_out = 0;
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1230
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1231	// receive datagrams
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1232	ec_device_poll(&master->main_device);
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1233
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1234	cycles_timeout = (cycles_t) EC_IO_TIMEOUT /* us / (cpu_khz / 1000);
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1235
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1236	// dequeue all datagrams that timed out
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1237	list_for_each_entry_safe(datagram, next, &master->datagram_queue, queue) {
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1238	if (datagram->state != EC_DATAGRAM_SENT) continue;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1239
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1240	if (master->main_device.cycles_poll - datagram->cycles_sent
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1241	> cycles_timeout) {
664 18c48cb7de06 Introduced frames_timed_out flag to notice bus failure when link down is Florian Pose <fp@igh-essen.com> parents: 663 diff changeset	1242	frames_timed_out = 1;
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1243	list_del_init(&datagram->queue);
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1244	datagram->state = EC_DATAGRAM_TIMED_OUT;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1245	master->stats.timeouts++;
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1246	ec_master_output_stats(master);
684 bf991809dcf0 Added debugging output for unmatched frames and those that timed out. Florian Pose <fp@igh-essen.com> parents: 664 diff changeset	1247
bf991809dcf0 Added debugging output for unmatched frames and those that timed out. Florian Pose <fp@igh-essen.com> parents: 664 diff changeset	1248	if (unlikely(master->debug_level > 0)) {
691 77b79a29e0e7 Included datagram queuing in critical section in idle task; added some Florian Pose <fp@igh-essen.com> parents: 690 diff changeset	1249	EC_DBG("TIMED OUT datagram %08x, index %02X waited %u us.\n",
77b79a29e0e7 Included datagram queuing in critical section in idle task; added some Florian Pose <fp@igh-essen.com> parents: 690 diff changeset	1250	(unsigned int) datagram, datagram->index,
684 bf991809dcf0 Added debugging output for unmatched frames and those that timed out. Florian Pose <fp@igh-essen.com> parents: 664 diff changeset	1251	(unsigned int) (master->main_device.cycles_poll
bf991809dcf0 Added debugging output for unmatched frames and those that timed out. Florian Pose <fp@igh-essen.com> parents: 664 diff changeset	1252	- datagram->cycles_sent) * 1000 / cpu_khz);
bf991809dcf0 Added debugging output for unmatched frames and those that timed out. Florian Pose <fp@igh-essen.com> parents: 664 diff changeset	1253	}
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1254	}
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1255	}
664 18c48cb7de06 Introduced frames_timed_out flag to notice bus failure when link down is Florian Pose <fp@igh-essen.com> parents: 663 diff changeset	1256
18c48cb7de06 Introduced frames_timed_out flag to notice bus failure when link down is Florian Pose <fp@igh-essen.com> parents: 663 diff changeset	1257	master->frames_timed_out = frames_timed_out;
640 16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1258	}
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1259
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1260	/*****************************************************************************/
16e9ad7d8e12 Added parameters for vendor ID and product code to ecrt_get_slave(); PDO Florian Pose <fp@igh-essen.com> parents: 639 diff changeset	1261
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1262	ec_slave_config_t ecrt_master_slave_config(ec_master_t master,
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1263	uint16_t alias, uint16_t position, uint32_t vendor_id,
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1264	uint32_t product_code)
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1265	{
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1266	ec_slave_config_t *sc;
697 6f658c2082fd Added ecrt_master_get_slave_by_pos(). Florian Pose <fp@igh-essen.com> parents: 692 diff changeset	1267	unsigned int found = 0;
6f658c2082fd Added ecrt_master_get_slave_by_pos(). Florian Pose <fp@igh-essen.com> parents: 692 diff changeset	1268
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1269	list_for_each_entry(sc, &master->configs, list) {
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1270	if (sc->alias == alias && sc->position == position) {
697 6f658c2082fd Added ecrt_master_get_slave_by_pos(). Florian Pose <fp@igh-essen.com> parents: 692 diff changeset	1271	found = 1;
6f658c2082fd Added ecrt_master_get_slave_by_pos(). Florian Pose <fp@igh-essen.com> parents: 692 diff changeset	1272	break;
6f658c2082fd Added ecrt_master_get_slave_by_pos(). Florian Pose <fp@igh-essen.com> parents: 692 diff changeset	1273	}
6f658c2082fd Added ecrt_master_get_slave_by_pos(). Florian Pose <fp@igh-essen.com> parents: 692 diff changeset	1274	}
6f658c2082fd Added ecrt_master_get_slave_by_pos(). Florian Pose <fp@igh-essen.com> parents: 692 diff changeset	1275
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1276	if (found) {
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1277	if (master->debug_level) {
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1278	EC_INFO("Using existing slave configuration for %u:%u\n",
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1279	alias, position);
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1280	}
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1281	if (sc->vendor_id != vendor_id \|\| sc->product_code != product_code) {
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1282	EC_ERR("Slave type mismatch. Slave was configured as"
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1283	" 0x%08X/0x%08X before. Now configuring with"
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1284	" 0x%08X/0x%08X.\n", sc->vendor_id, sc->product_code,
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1285	vendor_id, product_code);
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1286	return NULL;
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1287	}
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1288	} else {
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1289	if (master->debug_level) {
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1290	EC_INFO("Creating slave configuration for %u:%u,"
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1291	" 0x%08X/0x%08X.\n", alias, position, vendor_id,
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1292	product_code);
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1293	}
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1294
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1295	if (!(sc = (ec_slave_config_t *) kmalloc(sizeof(ec_slave_config_t),
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1296	GFP_KERNEL))) {
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1297	EC_ERR("Failed to allocate memory for slave configuration.\n");
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1298	return NULL;
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1299	}
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1300
995 54149a703c47 Removed kobject from slave_config. Florian Pose <fp@igh-essen.com> parents: 994 diff changeset	1301	ec_slave_config_init(sc, master,
54149a703c47 Removed kobject from slave_config. Florian Pose <fp@igh-essen.com> parents: 994 diff changeset	1302	alias, position, vendor_id, product_code);
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1303
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1304	// try to find the addressed slave
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1305	ec_slave_config_attach(sc);
879 9b395c5646ab Changed terms "Pdo mapping" -> "Pdo assignment" and "Pdo configuration" Florian Pose <fp@igh-essen.com> parents: 872 diff changeset	1306	ec_slave_config_load_default_assignment(sc);
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1307
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1308	list_add_tail(&sc->list, &master->configs);
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1309	}
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1310
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1311	return sc;
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1312	}
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1313
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1314	/*****************************************************************************/
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1315
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1316	void ecrt_master_callbacks(ec_master_t master, int (request_cb)(void *),
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1317	void (release_cb)(void ), void *cb_data)
204 5ab50514d9b2 Locking callback interface. Florian Pose <fp@igh-essen.com> parents: 203 diff changeset	1318	{
661 bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	1319	master->ext_request_cb = request_cb;
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	1320	master->ext_release_cb = release_cb;
bc1de1362efb Dynamic creation of EoE handlers. Florian Pose <fp@igh-essen.com> parents: 659 diff changeset	1321	master->ext_cb_data = cb_data;
204 5ab50514d9b2 Locking callback interface. Florian Pose <fp@igh-essen.com> parents: 203 diff changeset	1322	}
5ab50514d9b2 Locking callback interface. Florian Pose <fp@igh-essen.com> parents: 203 diff changeset	1323
5ab50514d9b2 Locking callback interface. Florian Pose <fp@igh-essen.com> parents: 203 diff changeset	1324	/*****************************************************************************/
5ab50514d9b2 Locking callback interface. Florian Pose <fp@igh-essen.com> parents: 203 diff changeset	1325
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1326	void ecrt_master_state(const ec_master_t master, ec_master_state_t state)
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1327	{
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1328	state->slaves_responding = master->fsm.slaves_responding;
612 aede068f9a74 Introduced master status, ecrt_master_get_status(), tainted flag, Florian Pose <fp@igh-essen.com> parents: 610 diff changeset	1329	}
aede068f9a74 Introduced master status, ecrt_master_get_status(), tainted flag, Florian Pose <fp@igh-essen.com> parents: 610 diff changeset	1330
aede068f9a74 Introduced master status, ecrt_master_get_status(), tainted flag, Florian Pose <fp@igh-essen.com> parents: 610 diff changeset	1331	/*****************************************************************************/
aede068f9a74 Introduced master status, ecrt_master_get_status(), tainted flag, Florian Pose <fp@igh-essen.com> parents: 610 diff changeset	1332
199 04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	1333	/** \cond */
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	1334
104 052bc82d5442 MERGE branches/async -> trunk (alle Unterschiede ?bernommen) Florian Pose <fp@igh-essen.com> parents: 101 diff changeset	1335	EXPORT_SYMBOL(ecrt_master_create_domain);
052bc82d5442 MERGE branches/async -> trunk (alle Unterschiede ?bernommen) Florian Pose <fp@igh-essen.com> parents: 101 diff changeset	1336	EXPORT_SYMBOL(ecrt_master_activate);
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 321 diff changeset	1337	EXPORT_SYMBOL(ecrt_master_send);
7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 321 diff changeset	1338	EXPORT_SYMBOL(ecrt_master_receive);
206 60a10d85c20b Prepared EoE processing with workqueue. Florian Pose <fp@igh-essen.com> parents: 204 diff changeset	1339	EXPORT_SYMBOL(ecrt_master_callbacks);
792 3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1340	EXPORT_SYMBOL(ecrt_master_slave_config);
3778920f61e4 Implemented most realtime interface changes for version 1.4, improved Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	1341	EXPORT_SYMBOL(ecrt_master_state);
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1342
199 04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	1343	/** \endcond */
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	1344
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	1345	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Thu, 12 Jun 2008 08:12:02 +0000
changeset 997	652180478e95
parent 995	54149a703c47
child 1000	5746fdd1ca2e
permissions	-rw-r--r--