etherlabmaster: master/slave.c@674071846ee3 (annotated)

39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	1	/******************************************************************************
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	2	*
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	3	* s l a v e . c
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	4	*
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	5	* EtherCAT slave methods.
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	6	*
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	7	* $Id$
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	8	*
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	9	*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	10
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	11	#include <linux/module.h>
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	12	#include <linux/delay.h>
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	13
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	14	#include "globals.h"
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	15	#include "slave.h"
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	16	#include "command.h"
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	17	#include "master.h"
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	18
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	19	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	20
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	21	int ec_slave_fetch_categories(ec_slave_t *);
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	22	int ec_slave_fetch_strings(ec_slave_t , const uint8_t );
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	23	int ec_slave_fetch_general(ec_slave_t , const uint8_t );
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	24	int ec_slave_fetch_sync(ec_slave_t , const uint8_t , size_t);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	25	int ec_slave_fetch_pdo(ec_slave_t , const uint8_t , size_t, ec_pdo_type_t);
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	26	int ec_slave_locate_string(ec_slave_t , unsigned int, char *);
182 8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	27	ssize_t ec_show_slave_attribute(struct kobject , struct attribute , char *);
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	28
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	29	/*****************************************************************************/
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	30
184 2fc86cec12df Macro for SysFS attribute definition Florian Pose <fp@igh-essen.com> parents: 183 diff changeset	31	EC_SYSFS_READ_ATTR(ring_position);
188 c0e49f4a1c07 Better calc. of coupler address; coupler address in SysFS; better output of ec_list Florian Pose <fp@igh-essen.com> parents: 185 diff changeset	32	EC_SYSFS_READ_ATTR(coupler_address);
184 2fc86cec12df Macro for SysFS attribute definition Florian Pose <fp@igh-essen.com> parents: 183 diff changeset	33	EC_SYSFS_READ_ATTR(vendor_name);
2fc86cec12df Macro for SysFS attribute definition Florian Pose <fp@igh-essen.com> parents: 183 diff changeset	34	EC_SYSFS_READ_ATTR(product_name);
2fc86cec12df Macro for SysFS attribute definition Florian Pose <fp@igh-essen.com> parents: 183 diff changeset	35	EC_SYSFS_READ_ATTR(product_desc);
185 af570302dcee Slave (special) type in SysFS Florian Pose <fp@igh-essen.com> parents: 184 diff changeset	36	EC_SYSFS_READ_ATTR(type);
182 8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	37
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	38	static struct attribute *def_attrs[] = {
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	39	&attr_ring_position,
188 c0e49f4a1c07 Better calc. of coupler address; coupler address in SysFS; better output of ec_list Florian Pose <fp@igh-essen.com> parents: 185 diff changeset	40	&attr_coupler_address,
183 8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	41	&attr_vendor_name,
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	42	&attr_product_name,
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	43	&attr_product_desc,
185 af570302dcee Slave (special) type in SysFS Florian Pose <fp@igh-essen.com> parents: 184 diff changeset	44	&attr_type,
182 8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	45	NULL,
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	46	};
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	47
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	48	static struct sysfs_ops sysfs_ops = {
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	49	.show = &ec_show_slave_attribute,
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	50	.store = NULL
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	51	};
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	52
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	53	static struct kobj_type ktype_ec_slave = {
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	54	.release = ec_slave_clear,
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	55	.sysfs_ops = &sysfs_ops,
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	56	.default_attrs = def_attrs
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	57	};
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	58
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	59	/*****************************************************************************/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	60
164 ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	61	const ec_code_msg_t al_status_messages[];
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	62
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	63	/*****************************************************************************/
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	64
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	65	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	66	Slave constructor.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	67	\return 0 in case of success, else < 0
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	68	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	69
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	70	int ec_slave_init(ec_slave_t slave, /< EtherCAT slave /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	71	ec_master_t master, /< EtherCAT master /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	72	uint16_t ring_position, /*< ring position /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	73	uint16_t station_address /*< station address to configure /
182 8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	74	)
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	75	{
142 e933f1adb550 Link Status ausgelesen. Florian Pose <fp@igh-essen.com> parents: 140 diff changeset	76	unsigned int i;
e933f1adb550 Link Status ausgelesen. Florian Pose <fp@igh-essen.com> parents: 140 diff changeset	77
182 8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	78	slave->ring_position = ring_position;
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	79	slave->station_address = station_address;
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	80
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	81	// init kobject and add it to the hierarchy
182 8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	82	memset(&slave->kobj, 0x00, sizeof(struct kobject));
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	83	kobject_init(&slave->kobj);
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	84	slave->kobj.ktype = &ktype_ec_slave;
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	85	slave->kobj.parent = &master->kobj;
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	86	if (kobject_set_name(&slave->kobj, "slave%03i", slave->ring_position)) {
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	87	EC_ERR("Failed to set kobject name.\n");
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	88	kobject_put(&slave->kobj);
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	89	return -1;
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	90	}
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	91
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	92	slave->master = master;
188 c0e49f4a1c07 Better calc. of coupler address; coupler address in SysFS; better output of ec_list Florian Pose <fp@igh-essen.com> parents: 185 diff changeset	93	slave->coupler_index = 0;
c0e49f4a1c07 Better calc. of coupler address; coupler address in SysFS; better output of ec_list Florian Pose <fp@igh-essen.com> parents: 185 diff changeset	94	slave->coupler_subindex = 0xFFFF;
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	95	slave->base_type = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	96	slave->base_revision = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	97	slave->base_build = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	98	slave->base_fmmu_count = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	99	slave->base_sync_count = 0;
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	100	slave->sii_alias = 0;
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	101	slave->sii_vendor_id = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	102	slave->sii_product_code = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	103	slave->sii_revision_number = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	104	slave->sii_serial_number = 0;
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	105	slave->sii_rx_mailbox_offset = 0;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	106	slave->sii_rx_mailbox_size = 0;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	107	slave->sii_tx_mailbox_offset = 0;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	108	slave->sii_tx_mailbox_size = 0;
133 b36d187ecc0b Unterst?tzte Prot. auslesen, Mailbox in Slave ausgelagert, Bugfix in Anzeige des Watch-Frames und erste SDO-List-Abfrage. Florian Pose <fp@igh-essen.com> parents: 132 diff changeset	109	slave->sii_mailbox_protocols = 0;
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	110	slave->type = NULL;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	111	slave->registered = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	112	slave->fmmu_count = 0;
121 1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	113	slave->eeprom_name = NULL;
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	114	slave->eeprom_group = NULL;
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	115	slave->eeprom_desc = NULL;
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	116
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	117	ec_command_init(&slave->mbox_command);
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	118
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	119	INIT_LIST_HEAD(&slave->eeprom_strings);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	120	INIT_LIST_HEAD(&slave->eeprom_syncs);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	121	INIT_LIST_HEAD(&slave->eeprom_pdos);
135 80d493917205 Laden der SDO Dictionaries funktioniert. Florian Pose <fp@igh-essen.com> parents: 133 diff changeset	122	INIT_LIST_HEAD(&slave->sdo_dictionary);
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	123
183 8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	124	for (i = 0; i < 4; i++) {
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	125	slave->dl_link[i] = 0;
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	126	slave->dl_loop[i] = 0;
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	127	slave->dl_signal[i] = 0;
190 4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	128	slave->sii_physical_layer[i] = 0xFF;
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	129	}
182 8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	130
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	131	return 0;
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	132	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	133
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	134	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	135
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	136	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	137	Slave destructor.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	138	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	139
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	140	void ec_slave_clear(struct kobject kobj /< kobject of the slave /)
182 8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	141	{
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	142	ec_slave_t *slave;
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	143	ec_eeprom_string_t string, next_str;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	144	ec_eeprom_sync_t sync, next_sync;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	145	ec_eeprom_pdo_t pdo, next_pdo;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	146	ec_eeprom_pdo_entry_t entry, next_ent;
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	147	ec_sdo_t sdo, next_sdo;
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	148	ec_sdo_entry_t en, next_en;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	149
182 8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	150	slave = container_of(kobj, ec_slave_t, kobj);
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	151
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	152	// free all string objects
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	153	list_for_each_entry_safe(string, next_str, &slave->eeprom_strings, list) {
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	154	list_del(&string->list);
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	155	kfree(string);
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	156	}
121 1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	157
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	158	// free all sync managers
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	159	list_for_each_entry_safe(sync, next_sync, &slave->eeprom_syncs, list) {
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	160	list_del(&sync->list);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	161	kfree(sync);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	162	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	163
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	164	// free all PDOs
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	165	list_for_each_entry_safe(pdo, next_pdo, &slave->eeprom_pdos, list) {
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	166	list_del(&pdo->list);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	167	if (pdo->name) kfree(pdo->name);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	168
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	169	// free all PDO entries
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	170	list_for_each_entry_safe(entry, next_ent, &pdo->entries, list) {
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	171	list_del(&entry->list);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	172	if (entry->name) kfree(entry->name);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	173	kfree(entry);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	174	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	175
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	176	kfree(pdo);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	177	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	178
121 1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	179	if (slave->eeprom_name) kfree(slave->eeprom_name);
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	180	if (slave->eeprom_group) kfree(slave->eeprom_group);
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	181	if (slave->eeprom_desc) kfree(slave->eeprom_desc);
135 80d493917205 Laden der SDO Dictionaries funktioniert. Florian Pose <fp@igh-essen.com> parents: 133 diff changeset	182
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	183	// free all SDOs
135 80d493917205 Laden der SDO Dictionaries funktioniert. Florian Pose <fp@igh-essen.com> parents: 133 diff changeset	184	list_for_each_entry_safe(sdo, next_sdo, &slave->sdo_dictionary, list) {
80d493917205 Laden der SDO Dictionaries funktioniert. Florian Pose <fp@igh-essen.com> parents: 133 diff changeset	185	list_del(&sdo->list);
80d493917205 Laden der SDO Dictionaries funktioniert. Florian Pose <fp@igh-essen.com> parents: 133 diff changeset	186	if (sdo->name) kfree(sdo->name);
161 ddb7266d1c56 Bugfix: Discovered memory leak. Florian Pose <fp@igh-essen.com> parents: 160 diff changeset	187
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	188	// free all SDO entries
139 998215ab9b92 Laden der SDO-Subindizes. Florian Pose <fp@igh-essen.com> parents: 138 diff changeset	189	list_for_each_entry_safe(en, next_en, &sdo->entries, list) {
998215ab9b92 Laden der SDO-Subindizes. Florian Pose <fp@igh-essen.com> parents: 138 diff changeset	190	list_del(&en->list);
998215ab9b92 Laden der SDO-Subindizes. Florian Pose <fp@igh-essen.com> parents: 138 diff changeset	191	kfree(en);
998215ab9b92 Laden der SDO-Subindizes. Florian Pose <fp@igh-essen.com> parents: 138 diff changeset	192	}
135 80d493917205 Laden der SDO Dictionaries funktioniert. Florian Pose <fp@igh-essen.com> parents: 133 diff changeset	193	kfree(sdo);
80d493917205 Laden der SDO Dictionaries funktioniert. Florian Pose <fp@igh-essen.com> parents: 133 diff changeset	194	}
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	195
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	196	ec_command_clear(&slave->mbox_command);
121 1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	197	}
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	198
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	199	/*****************************************************************************/
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	200
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	201	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	202	Reads all necessary information from a slave.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	203	\return 0 in case of success, else < 0
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	204	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	205
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	206	int ec_slave_fetch(ec_slave_t slave /< EtherCAT slave /)
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	207	{
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	208	ec_command_t *command;
142 e933f1adb550 Link Status ausgelesen. Florian Pose <fp@igh-essen.com> parents: 140 diff changeset	209	unsigned int i;
e933f1adb550 Link Status ausgelesen. Florian Pose <fp@igh-essen.com> parents: 140 diff changeset	210	uint16_t dl_status;
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	211
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	212	command = &slave->master->simple_command;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	213
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	214	// read base data
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	215	if (ec_command_nprd(command, slave->station_address, 0x0000, 6)) return -1;
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	216	if (unlikely(ec_master_simple_io(slave->master, command))) {
142 e933f1adb550 Link Status ausgelesen. Florian Pose <fp@igh-essen.com> parents: 140 diff changeset	217	EC_ERR("Reading base data from slave %i failed!\n",
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	218	slave->ring_position);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	219	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	220	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	221
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	222	slave->base_type = EC_READ_U8 (command->data);
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	223	slave->base_revision = EC_READ_U8 (command->data + 1);
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	224	slave->base_build = EC_READ_U16(command->data + 2);
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	225	slave->base_fmmu_count = EC_READ_U8 (command->data + 4);
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	226	slave->base_sync_count = EC_READ_U8 (command->data + 5);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	227
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	228	if (slave->base_fmmu_count > EC_MAX_FMMUS)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	229	slave->base_fmmu_count = EC_MAX_FMMUS;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	230
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	231	// read data link status
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	232	if (ec_command_nprd(command, slave->station_address, 0x0110, 2)) return -1;
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	233	if (unlikely(ec_master_simple_io(slave->master, command))) {
142 e933f1adb550 Link Status ausgelesen. Florian Pose <fp@igh-essen.com> parents: 140 diff changeset	234	EC_ERR("Reading DL status from slave %i failed!\n",
e933f1adb550 Link Status ausgelesen. Florian Pose <fp@igh-essen.com> parents: 140 diff changeset	235	slave->ring_position);
e933f1adb550 Link Status ausgelesen. Florian Pose <fp@igh-essen.com> parents: 140 diff changeset	236	return -1;
e933f1adb550 Link Status ausgelesen. Florian Pose <fp@igh-essen.com> parents: 140 diff changeset	237	}
e933f1adb550 Link Status ausgelesen. Florian Pose <fp@igh-essen.com> parents: 140 diff changeset	238
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	239	dl_status = EC_READ_U16(command->data);
183 8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	240	for (i = 0; i < 4; i++) {
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	241	slave->dl_link[i] = dl_status & (1 << (4 + i)) ? 1 : 0;
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	242	slave->dl_loop[i] = dl_status & (1 << (8 + i * 2)) ? 1 : 0;
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	243	slave->dl_signal[i] = dl_status & (1 << (9 + i * 2)) ? 1 : 0;
142 e933f1adb550 Link Status ausgelesen. Florian Pose <fp@igh-essen.com> parents: 140 diff changeset	244	}
e933f1adb550 Link Status ausgelesen. Florian Pose <fp@igh-essen.com> parents: 140 diff changeset	245
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	246	// read EEPROM data
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	247	if (ec_slave_sii_read16(slave, 0x0004, &slave->sii_alias))
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	248	return -1;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	249	if (ec_slave_sii_read32(slave, 0x0008, &slave->sii_vendor_id))
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	250	return -1;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	251	if (ec_slave_sii_read32(slave, 0x000A, &slave->sii_product_code))
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	252	return -1;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	253	if (ec_slave_sii_read32(slave, 0x000C, &slave->sii_revision_number))
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	254	return -1;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	255	if (ec_slave_sii_read32(slave, 0x000E, &slave->sii_serial_number))
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	256	return -1;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	257	if (ec_slave_sii_read16(slave, 0x0018, &slave->sii_rx_mailbox_offset))
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	258	return -1;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	259	if (ec_slave_sii_read16(slave, 0x0019, &slave->sii_rx_mailbox_size))
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	260	return -1;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	261	if (ec_slave_sii_read16(slave, 0x001A, &slave->sii_tx_mailbox_offset))
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	262	return -1;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	263	if (ec_slave_sii_read16(slave, 0x001B, &slave->sii_tx_mailbox_size))
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	264	return -1;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	265	if (ec_slave_sii_read16(slave, 0x001C, &slave->sii_mailbox_protocols))
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	266	return -1;
133 b36d187ecc0b Unterst?tzte Prot. auslesen, Mailbox in Slave ausgelagert, Bugfix in Anzeige des Watch-Frames und erste SDO-List-Abfrage. Florian Pose <fp@igh-essen.com> parents: 132 diff changeset	267
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	268	if (unlikely(ec_slave_fetch_categories(slave))) {
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	269	EC_ERR("Failed to fetch category data!\n");
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	270	return -1;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	271	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	272
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	273	return 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	274	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	275
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	276	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	277
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	278	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	279	Reads 16 bit from the slave information interface (SII).
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	280	\return 0 in case of success, else < 0
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	281	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	282
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	283	int ec_slave_sii_read16(ec_slave_t *slave,
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	284	/*< EtherCAT slave /
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	285	uint16_t offset,
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	286	/*< address of the SII register to read /
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	287	uint16_t *target
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	288	/*< target memory /
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	289	)
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	290	{
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	291	ec_command_t *command;
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	292	cycles_t start, end, timeout;
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	293
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	294	command = &slave->master->simple_command;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	295
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	296	// initiate read operation
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	297	if (ec_command_npwr(command, slave->station_address, 0x502, 6)) return -1;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	298	EC_WRITE_U8 (command->data, 0x00); // read-only access
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	299	EC_WRITE_U8 (command->data + 1, 0x01); // request read operation
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	300	EC_WRITE_U32(command->data + 2, offset);
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	301	if (unlikely(ec_master_simple_io(slave->master, command))) {
89 e91ef35c36db Wiederholtes Senden, wenn keine Antwort. Florian Pose <fp@igh-essen.com> parents: 84 diff changeset	302	EC_ERR("SII-read failed on slave %i!\n", slave->ring_position);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	303	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	304	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	305
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	306	start = get_cycles();
119 b2de89096010 Verschiedene Timeouts verl?ngert. Florian Pose <fp@igh-essen.com> parents: 118 diff changeset	307	timeout = (cycles_t) 100 * cpu_khz; // 100ms
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	308
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	309	while (1)
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	310	{
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	311	udelay(10);
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	312
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	313	if (ec_command_nprd(command, slave->station_address, 0x502, 10))
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	314	return -1;
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	315	if (unlikely(ec_master_simple_io(slave->master, command))) {
89 e91ef35c36db Wiederholtes Senden, wenn keine Antwort. Florian Pose <fp@igh-essen.com> parents: 84 diff changeset	316	EC_ERR("Getting SII-read status failed on slave %i!\n",
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	317	slave->ring_position);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	318	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	319	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	320
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	321	end = get_cycles();
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	322
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	323	// check for "busy bit"
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	324	if (likely((EC_READ_U8(command->data + 1) & 0x81) == 0)) {
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	325	*target = EC_READ_U16(command->data + 6);
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	326	return 0;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	327	}
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	328
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	329	if (unlikely((end - start) >= timeout)) {
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	330	EC_ERR("SII-read. Slave %i timed out!\n", slave->ring_position);
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	331	return -1;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	332	}
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	333	}
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	334	}
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	335
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	336	/*****************************************************************************/
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	337
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	338	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	339	Reads 32 bit from the slave information interface (SII).
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	340	\return 0 in case of success, else < 0
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	341	*/
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	342
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	343	int ec_slave_sii_read32(ec_slave_t *slave,
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	344	/*< EtherCAT slave /
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	345	uint16_t offset,
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	346	/*< address of the SII register to read /
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	347	uint32_t *target
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	348	/*< target memory /
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	349	)
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	350	{
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	351	ec_command_t *command;
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	352	cycles_t start, end, timeout;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	353
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	354	command = &slave->master->simple_command;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	355
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	356	// initiate read operation
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	357	if (ec_command_npwr(command, slave->station_address, 0x502, 6)) return -1;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	358	EC_WRITE_U8 (command->data, 0x00); // read-only access
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	359	EC_WRITE_U8 (command->data + 1, 0x01); // request read operation
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	360	EC_WRITE_U32(command->data + 2, offset);
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	361	if (unlikely(ec_master_simple_io(slave->master, command))) {
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	362	EC_ERR("SII-read failed on slave %i!\n", slave->ring_position);
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	363	return -1;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	364	}
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	365
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	366	start = get_cycles();
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	367	timeout = (cycles_t) 100 * cpu_khz; // 100ms
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	368
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	369	while (1)
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	370	{
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	371	udelay(10);
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	372
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	373	if (ec_command_nprd(command, slave->station_address, 0x502, 10))
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	374	return -1;
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	375	if (unlikely(ec_master_simple_io(slave->master, command))) {
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	376	EC_ERR("Getting SII-read status failed on slave %i!\n",
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	377	slave->ring_position);
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	378	return -1;
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	379	}
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	380
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	381	end = get_cycles();
a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	382
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	383	// check "busy bit"
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	384	if (likely((EC_READ_U8(command->data + 1) & 0x81) == 0)) {
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	385	*target = EC_READ_U32(command->data + 6);
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	386	return 0;
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	387	}
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	388
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	389	if (unlikely((end - start) >= timeout)) {
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	390	EC_ERR("SII-read. Slave %i timed out!\n", slave->ring_position);
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	391	return -1;
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	392	}
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	393	}
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	394	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	395
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	396	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	397
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	398	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	399	Writes 16 bit of data to the slave information interface (SII).
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	400	\return 0 in case of success, else < 0
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	401	*/
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	402
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	403	int ec_slave_sii_write16(ec_slave_t *slave,
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	404	/*< EtherCAT slave /
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	405	uint16_t offset,
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	406	/*< address of the SII register to write /
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	407	uint16_t value
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	408	/*< new value /
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	409	)
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	410	{
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	411	ec_command_t *command;
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	412	cycles_t start, end, timeout;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	413
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	414	command = &slave->master->simple_command;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	415
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	416	EC_INFO("SII-write (slave %i, offset 0x%04X, value 0x%04X)\n",
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	417	slave->ring_position, offset, value);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	418
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	419	// initiate write operation
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	420	if (ec_command_npwr(command, slave->station_address, 0x502, 8)) return -1;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	421	EC_WRITE_U8 (command->data, 0x01); // enable write access
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	422	EC_WRITE_U8 (command->data + 1, 0x02); // request write operation
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	423	EC_WRITE_U32(command->data + 2, offset);
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	424	EC_WRITE_U16(command->data + 6, value);
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	425	if (unlikely(ec_master_simple_io(slave->master, command))) {
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	426	EC_ERR("SII-write failed on slave %i!\n", slave->ring_position);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	427	return -1;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	428	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	429
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	430	start = get_cycles();
119 b2de89096010 Verschiedene Timeouts verl?ngert. Florian Pose <fp@igh-essen.com> parents: 118 diff changeset	431	timeout = (cycles_t) 100 * cpu_khz; // 100ms
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	432
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	433	while (1)
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	434	{
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	435	udelay(10);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	436
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	437	if (ec_command_nprd(command, slave->station_address, 0x502, 2))
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	438	return -1;
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	439	if (unlikely(ec_master_simple_io(slave->master, command))) {
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	440	EC_ERR("Getting SII-write status failed on slave %i!\n",
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	441	slave->ring_position);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	442	return -1;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	443	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	444
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	445	end = get_cycles();
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	446
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	447	// check "busy bit"
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	448	if (likely((EC_READ_U8(command->data + 1) & 0x82) == 0)) {
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	449	if (EC_READ_U8(command->data + 1) & 0x40) {
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	450	EC_ERR("SII-write failed!\n");
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	451	return -1;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	452	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	453	else {
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	454	EC_INFO("SII-write succeeded!\n");
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	455	return 0;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	456	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	457	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	458
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	459	if (unlikely((end - start) >= timeout)) {
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	460	EC_ERR("SII-write: Slave %i timed out!\n", slave->ring_position);
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	461	return -1;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	462	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	463	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	464	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	465
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	466	/*****************************************************************************/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	467
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	468	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	469	Fetches data from slave's EEPROM.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	470	\return 0 in case of success, else < 0
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	471	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	472
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	473	int ec_slave_fetch_categories(ec_slave_t slave /< EtherCAT slave /)
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	474	{
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	475	uint16_t word_offset, cat_type, word_count;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	476	uint32_t value;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	477	uint8_t *cat_data;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	478	unsigned int i;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	479
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	480	word_offset = 0x0040;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	481
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	482	if (!(cat_data = (uint8_t *) kmalloc(0x10000, GFP_KERNEL))) {
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	483	EC_ERR("Failed to allocate 64k bytes for category data.\n");
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	484	return -1;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	485	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	486
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	487	while (1) {
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	488	// read category type
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	489	if (ec_slave_sii_read32(slave, word_offset, &value)) {
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	490	EC_ERR("Unable to read category header.\n");
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	491	goto out_free;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	492	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	493
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	494	// last category?
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	495	if ((value & 0xFFFF) == 0xFFFF) break;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	496
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	497	cat_type = value & 0x7FFF;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	498	word_count = (value >> 16) & 0xFFFF;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	499
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	500	// fetch category data
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	501	for (i = 0; i < word_count; i++) {
136 a03a684cac89 Dynamische Mailbox-Kommunikation, auch mit unbekannten Slaves. Florian Pose <fp@igh-essen.com> parents: 135 diff changeset	502	if (ec_slave_sii_read32(slave, word_offset + 2 + i, &value)) {
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	503	EC_ERR("Unable to read category data word %i.\n", i);
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	504	goto out_free;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	505	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	506
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	507	cat_data[i * 2] = (value >> 0) & 0xFF;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	508	cat_data[i * 2 + 1] = (value >> 8) & 0xFF;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	509
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	510	// read second word "on the fly"
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	511	if (i + 1 < word_count) {
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	512	i++;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	513	cat_data[i * 2] = (value >> 16) & 0xFF;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	514	cat_data[i * 2 + 1] = (value >> 24) & 0xFF;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	515	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	516	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	517
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	518	switch (cat_type)
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	519	{
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	520	case 0x000A:
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	521	if (ec_slave_fetch_strings(slave, cat_data))
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	522	goto out_free;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	523	break;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	524	case 0x001E:
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	525	if (ec_slave_fetch_general(slave, cat_data))
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	526	goto out_free;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	527	break;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	528	case 0x0028:
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	529	break;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	530	case 0x0029:
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	531	if (ec_slave_fetch_sync(slave, cat_data, word_count))
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	532	goto out_free;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	533	break;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	534	case 0x0032:
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	535	if (ec_slave_fetch_pdo(slave, cat_data, word_count, EC_TX_PDO))
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	536	goto out_free;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	537	break;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	538	case 0x0033:
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	539	if (ec_slave_fetch_pdo(slave, cat_data, word_count, EC_RX_PDO))
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	540	goto out_free;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	541	break;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	542	default:
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	543	EC_WARN("Unknown category type 0x%04X in slave %i.\n",
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	544	cat_type, slave->ring_position);
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	545	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	546
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	547	word_offset += 2 + word_count;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	548	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	549
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	550	kfree(cat_data);
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	551	return 0;
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	552
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	553	out_free:
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	554	kfree(cat_data);
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	555	return -1;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	556	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	557
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	558	/*****************************************************************************/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	559
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	560	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	561	Fetches data from a STRING category.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	562	\return 0 in case of success, else < 0
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	563	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	564
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	565	int ec_slave_fetch_strings(ec_slave_t slave, /< EtherCAT slave /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	566	const uint8_t data /< category data /
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	567	)
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	568	{
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	569	unsigned int string_count, i;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	570	size_t size;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	571	off_t offset;
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	572	ec_eeprom_string_t *string;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	573
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	574	string_count = data[0];
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	575	offset = 1;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	576	for (i = 0; i < string_count; i++) {
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	577	size = data[offset];
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	578	// allocate memory for string structure and data at a single blow
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	579	if (!(string = (ec_eeprom_string_t *)
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	580	kmalloc(sizeof(ec_eeprom_string_t) + size + 1, GFP_KERNEL))) {
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	581	EC_ERR("Failed to allocate string memory.\n");
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	582	return -1;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	583	}
121 1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	584	string->size = size;
161 ddb7266d1c56 Bugfix: Discovered memory leak. Florian Pose <fp@igh-essen.com> parents: 160 diff changeset	585	// string memory appended to string structure
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	586	string->data = (char *) string + sizeof(ec_eeprom_string_t);
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	587	memcpy(string->data, data + offset + 1, size);
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	588	string->data[size] = 0x00;
121 1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	589	list_add_tail(&string->list, &slave->eeprom_strings);
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	590	offset += 1 + size;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	591	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	592
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	593	return 0;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	594	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	595
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	596	/*****************************************************************************/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	597
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	598	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	599	Fetches data from a GENERAL category.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	600	\return 0 in case of success, else < 0
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	601	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	602
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	603	int ec_slave_fetch_general(ec_slave_t slave, /< EtherCAT slave /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	604	const uint8_t data /< category data /
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	605	)
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	606	{
190 4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	607	unsigned int i;
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	608
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	609	if (ec_slave_locate_string(slave, data[0], &slave->eeprom_group))
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	610	return -1;
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	611	if (ec_slave_locate_string(slave, data[1], &slave->eeprom_name))
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	612	return -1;
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	613	if (ec_slave_locate_string(slave, data[3], &slave->eeprom_desc))
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	614	return -1;
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	615
190 4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	616	for (i = 0; i < 4; i++)
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	617	slave->sii_physical_layer[i] =
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	618	(data[4] & (0x03 << (i * 2))) >> (i * 2);
190 4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	619
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	620	return 0;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	621	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	622
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	623	/*****************************************************************************/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	624
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	625	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	626	Fetches data from a SYNC MANAGER category.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	627	\return 0 in case of success, else < 0
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	628	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	629
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	630	int ec_slave_fetch_sync(ec_slave_t slave, /< EtherCAT slave /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	631	const uint8_t data, /< category data /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	632	size_t word_count /*< number of words /
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	633	)
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	634	{
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	635	unsigned int sync_count, i;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	636	ec_eeprom_sync_t *sync;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	637
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	638	sync_count = word_count / 4; // sync manager struct is 4 words long
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	639
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	640	for (i = 0; i < sync_count; i++, data += 8) {
127 e67c80a76de4 Code aufger?umt und kleines Speicherleck entdeckt. Florian Pose <fp@igh-essen.com> parents: 126 diff changeset	641	if (!(sync = (ec_eeprom_sync_t *)
e67c80a76de4 Code aufger?umt und kleines Speicherleck entdeckt. Florian Pose <fp@igh-essen.com> parents: 126 diff changeset	642	kmalloc(sizeof(ec_eeprom_sync_t), GFP_KERNEL))) {
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	643	EC_ERR("Failed to allocate Sync-Manager memory.\n");
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	644	return -1;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	645	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	646
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	647	sync->index = i;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	648	sync->physical_start_address = ((uint16_t ) (data + 0));
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	649	sync->length = ((uint16_t ) (data + 2));
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	650	sync->control_register = data[4];
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	651	sync->enable = data[6];
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	652
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	653	list_add_tail(&sync->list, &slave->eeprom_syncs);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	654	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	655
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	656	return 0;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	657	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	658
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	659	/*****************************************************************************/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	660
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	661	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	662	Fetches data from a [RT]XPDO category.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	663	\return 0 in case of success, else < 0
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	664	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	665
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	666	int ec_slave_fetch_pdo(ec_slave_t slave, /< EtherCAT slave /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	667	const uint8_t data, /< category data /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	668	size_t word_count, /*< number of words /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	669	ec_pdo_type_t pdo_type /*< PDO type /
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	670	)
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	671	{
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	672	ec_eeprom_pdo_t *pdo;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	673	ec_eeprom_pdo_entry_t *entry;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	674	unsigned int entry_count, i;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	675
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	676	while (word_count >= 4) {
127 e67c80a76de4 Code aufger?umt und kleines Speicherleck entdeckt. Florian Pose <fp@igh-essen.com> parents: 126 diff changeset	677	if (!(pdo = (ec_eeprom_pdo_t *)
e67c80a76de4 Code aufger?umt und kleines Speicherleck entdeckt. Florian Pose <fp@igh-essen.com> parents: 126 diff changeset	678	kmalloc(sizeof(ec_eeprom_pdo_t), GFP_KERNEL))) {
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	679	EC_ERR("Failed to allocate PDO memory.\n");
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	680	return -1;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	681	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	682
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	683	INIT_LIST_HEAD(&pdo->entries);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	684	pdo->type = pdo_type;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	685
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	686	pdo->index = ((uint16_t ) data);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	687	entry_count = data[2];
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	688	pdo->sync_manager = data[3];
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	689	pdo->name = NULL;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	690	ec_slave_locate_string(slave, data[5], &pdo->name);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	691
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	692	list_add_tail(&pdo->list, &slave->eeprom_pdos);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	693
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	694	word_count -= 4;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	695	data += 8;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	696
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	697	for (i = 0; i < entry_count; i++) {
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	698	if (!(entry = (ec_eeprom_pdo_entry_t *)
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	699	kmalloc(sizeof(ec_eeprom_pdo_entry_t), GFP_KERNEL))) {
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	700	EC_ERR("Failed to allocate PDO entry memory.\n");
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	701	return -1;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	702	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	703
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	704	entry->index = ((uint16_t ) data);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	705	entry->subindex = data[2];
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	706	entry->name = NULL;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	707	ec_slave_locate_string(slave, data[3], &entry->name);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	708	entry->bit_length = data[5];
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	709
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	710	list_add_tail(&entry->list, &pdo->entries);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	711
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	712	word_count -= 4;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	713	data += 8;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	714	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	715	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	716
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	717	return 0;
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	718	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	719
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	720	/*****************************************************************************/
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	721
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	722	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	723	Searches the string list for an index and allocates a new string.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	724	\return 0 in case of success, else < 0
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	725	*/
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	726
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	727	int ec_slave_locate_string(ec_slave_t slave, unsigned int index, char *ptr)
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	728	{
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	729	ec_eeprom_string_t *string;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	730	char *err_string;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	731
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	732	// Erst alten Speicher freigeben
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	733	if (*ptr) {
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	734	kfree(*ptr);
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	735	*ptr = NULL;
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	736	}
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	737
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	738	// Index 0 bedeutet "nicht belegt"
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	739	if (!index) return 0;
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	740
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	741	// EEPROM-String mit Index finden und kopieren
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	742	list_for_each_entry(string, &slave->eeprom_strings, list) {
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	743	if (--index) continue;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	744
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	745	if (!(ptr = (char ) kmalloc(string->size + 1, GFP_KERNEL))) {
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	746	EC_ERR("Unable to allocate string memory.\n");
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	747	return -1;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	748	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	749	memcpy(*ptr, string->data, string->size + 1);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	750	return 0;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	751	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	752
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	753	EC_WARN("String %i not found in slave %i.\n", index, slave->ring_position);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	754
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	755	err_string = "(string not found)";
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	756
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	757	if (!(ptr = (char ) kmalloc(strlen(err_string) + 1, GFP_KERNEL))) {
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	758	EC_ERR("Unable to allocate string memory.\n");
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	759	return -1;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	760	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	761
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	762	memcpy(*ptr, err_string, strlen(err_string) + 1);
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	763	return 0;
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	764	}
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	765
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	766	/*****************************************************************************/
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	767
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	768	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	769	Acknowledges an error after a state transition.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	770	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	771
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	772	void ec_slave_state_ack(ec_slave_t slave, /< EtherCAT slave /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	773	uint8_t state /*< previous state /
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	774	)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	775	{
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	776	ec_command_t *command;
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	777	cycles_t start, end, timeout;
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	778
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	779	command = &slave->master->simple_command;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	780
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	781	if (ec_command_npwr(command, slave->station_address, 0x0120, 2)) return;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	782	EC_WRITE_U16(command->data, state \| EC_ACK);
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	783	if (unlikely(ec_master_simple_io(slave->master, command))) {
163 a1eea08070e1 Fixed state acknowledgement. Florian Pose <fp@igh-essen.com> parents: 161 diff changeset	784	EC_WARN("Acknowledge sending failed on slave %i!\n",
a1eea08070e1 Fixed state acknowledgement. Florian Pose <fp@igh-essen.com> parents: 161 diff changeset	785	slave->ring_position);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	786	return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	787	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	788
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	789	start = get_cycles();
119 b2de89096010 Verschiedene Timeouts verl?ngert. Florian Pose <fp@igh-essen.com> parents: 118 diff changeset	790	timeout = (cycles_t) 10 * cpu_khz; // 10ms
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	791
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	792	while (1)
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	793	{
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	794	udelay(100); // wait a little bit...
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	795
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	796	if (ec_command_nprd(command, slave->station_address, 0x0130, 2))
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	797	return;
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	798	if (unlikely(ec_master_simple_io(slave->master, command))) {
163 a1eea08070e1 Fixed state acknowledgement. Florian Pose <fp@igh-essen.com> parents: 161 diff changeset	799	EC_WARN("Acknowledge checking failed on slave %i!\n",
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	800	slave->ring_position);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	801	return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	802	}
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	803
163 a1eea08070e1 Fixed state acknowledgement. Florian Pose <fp@igh-essen.com> parents: 161 diff changeset	804	end = get_cycles();
a1eea08070e1 Fixed state acknowledgement. Florian Pose <fp@igh-essen.com> parents: 161 diff changeset	805
a1eea08070e1 Fixed state acknowledgement. Florian Pose <fp@igh-essen.com> parents: 161 diff changeset	806	if (likely(EC_READ_U8(command->data) == state)) {
a1eea08070e1 Fixed state acknowledgement. Florian Pose <fp@igh-essen.com> parents: 161 diff changeset	807	EC_INFO("Acknowleged state 0x%02X on slave %i.\n", state,
a1eea08070e1 Fixed state acknowledgement. Florian Pose <fp@igh-essen.com> parents: 161 diff changeset	808	slave->ring_position);
a1eea08070e1 Fixed state acknowledgement. Florian Pose <fp@igh-essen.com> parents: 161 diff changeset	809	return;
a1eea08070e1 Fixed state acknowledgement. Florian Pose <fp@igh-essen.com> parents: 161 diff changeset	810	}
a1eea08070e1 Fixed state acknowledgement. Florian Pose <fp@igh-essen.com> parents: 161 diff changeset	811
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	812	if (unlikely((end - start) >= timeout)) {
164 ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	813	EC_WARN("Failed to acknowledge state 0x%02X on slave %i"
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	814	" - Timeout!\n", state, slave->ring_position);
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	815	return;
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	816	}
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	817	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	818	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	819
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	820	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	821
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	822	/**
164 ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	823	Reads the AL status code of a slave and displays it.
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	824	If the AL status code is not supported, or if no error occurred (both
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	825	resulting in code=0), nothing is displayed.
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	826	*/
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	827
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	828	void ec_slave_read_al_status_code(ec_slave_t slave /< EtherCAT slave /)
164 ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	829	{
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	830	ec_command_t *command;
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	831	uint16_t code;
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	832	const ec_code_msg_t *al_msg;
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	833
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	834	command = &slave->master->simple_command;
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	835
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	836	if (ec_command_nprd(command, slave->station_address, 0x0134, 2)) return;
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	837	if (unlikely(ec_master_simple_io(slave->master, command))) {
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	838	EC_WARN("Failed to read AL status code on slave %i!\n",
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	839	slave->ring_position);
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	840	return;
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	841	}
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	842
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	843	if (!(code = EC_READ_U16(command->data))) return;
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	844
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	845	for (al_msg = al_status_messages; al_msg->code; al_msg++) {
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	846	if (al_msg->code == code) {
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	847	EC_ERR("AL status message 0x%04X: \"%s\".\n",
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	848	al_msg->code, al_msg->message);
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	849	return;
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	850	}
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	851	}
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	852
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	853	EC_ERR("Unknown AL status code 0x%04X.\n", code);
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	854	}
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	855
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	856	/*****************************************************************************/
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	857
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	858	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	859	Does a state transition.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	860	\return 0 in case of success, else < 0
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	861	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	862
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	863	int ec_slave_state_change(ec_slave_t slave, /< EtherCAT slave /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	864	uint8_t state /*< new state /
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	865	)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	866	{
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	867	ec_command_t *command;
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	868	cycles_t start, end, timeout;
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	869
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	870	command = &slave->master->simple_command;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	871
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	872	if (ec_command_npwr(command, slave->station_address, 0x0120, 2)) return -1;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	873	EC_WRITE_U16(command->data, state);
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	874	if (unlikely(ec_master_simple_io(slave->master, command))) {
164 ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	875	EC_ERR("Failed to set state 0x%02X on slave %i!\n",
89 e91ef35c36db Wiederholtes Senden, wenn keine Antwort. Florian Pose <fp@igh-essen.com> parents: 84 diff changeset	876	state, slave->ring_position);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	877	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	878	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	879
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	880	start = get_cycles();
119 b2de89096010 Verschiedene Timeouts verl?ngert. Florian Pose <fp@igh-essen.com> parents: 118 diff changeset	881	timeout = (cycles_t) 10 * cpu_khz; // 10ms
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	882
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	883	while (1)
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	884	{
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	885	udelay(100); // wait a little bit
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	886
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	887	if (ec_command_nprd(command, slave->station_address, 0x0130, 2))
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	888	return -1;
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	889	if (unlikely(ec_master_simple_io(slave->master, command))) {
164 ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	890	EC_ERR("Failed to check state 0x%02X on slave %i!\n",
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	891	state, slave->ring_position);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	892	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	893	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	894
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	895	end = get_cycles();
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	896
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	897	if (unlikely(EC_READ_U8(command->data) & 0x10)) { // state change error
164 ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	898	EC_ERR("Failed to set state 0x%02X - Slave %i refused state change"
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	899	" (code 0x%02X)!\n", state, slave->ring_position,
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	900	EC_READ_U8(command->data));
164 ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	901	state = EC_READ_U8(command->data) & 0x0F;
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	902	ec_slave_read_al_status_code(slave);
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	903	ec_slave_state_ack(slave, state);
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	904	return -1;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	905	}
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	906
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	907	if (likely(EC_READ_U8(command->data) == (state & 0x0F)))
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	908	return 0; // state change successful
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	909
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	910	if (unlikely((end - start) >= timeout)) {
164 ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	911	EC_ERR("Failed to check state 0x%02X of slave %i - Timeout!\n",
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	912	state, slave->ring_position);
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	913	return -1;
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	914	}
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	915	}
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	916	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	917
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	918	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	919
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	920	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	921	Prepares an FMMU configuration.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	922	Configuration data for the FMMU is saved in the slave structure and is
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	923	written to the slave in ecrt_master_activate().
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	924	The FMMU configuration is done in a way, that the complete data range
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	925	of the corresponding sync manager is covered. Seperate FMMUs arce configured
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	926	for each domain.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	927	If the FMMU configuration is already prepared, the function returns with
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	928	success.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	929	\return 0 in case of success, else < 0
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	930	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	931
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	932	int ec_slave_prepare_fmmu(ec_slave_t slave, /< EtherCAT slave /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	933	const ec_domain_t domain, /< domain /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	934	const ec_sync_t sync /< sync manager /
160 7ddf8367196a Renamed slave_set_fmmu() to slave_prepare_fmmu(). Florian Pose <fp@igh-essen.com> parents: 157 diff changeset	935	)
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	936	{
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	937	unsigned int i;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	938
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	939	// FMMU configuration already prepared?
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	940	for (i = 0; i < slave->fmmu_count; i++)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	941	if (slave->fmmus[i].domain == domain && slave->fmmus[i].sync == sync)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	942	return 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	943
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	944	// reserve new FMMU...
91 0120d6214948 Code-Dokumentation angepasst. Florian Pose <fp@igh-essen.com> parents: 89 diff changeset	945
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	946	if (slave->fmmu_count >= slave->base_fmmu_count) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	947	EC_ERR("Slave %i FMMU limit reached!\n", slave->ring_position);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	948	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	949	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	950
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	951	slave->fmmus[slave->fmmu_count].domain = domain;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	952	slave->fmmus[slave->fmmu_count].sync = sync;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	953	slave->fmmus[slave->fmmu_count].logical_start_address = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	954	slave->fmmu_count++;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	955	slave->registered = 1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	956
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	957	return 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	958	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	959
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	960	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	961
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	962	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	963	Outputs all information about a certain slave.
140 b09658e50d6f Verbosity level in ecrt_master_print(). Florian Pose <fp@igh-essen.com> parents: 139 diff changeset	964	Verbosity:
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	965	- 0: Only slave types and addresses
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	966	- 1: with EEPROM information
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	967	- >1: with SDO dictionaries
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	968	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	969
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	970	void ec_slave_print(const ec_slave_t slave, /< EtherCAT slave /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	971	unsigned int verbosity /*< verbosity level /
140 b09658e50d6f Verbosity level in ecrt_master_print(). Florian Pose <fp@igh-essen.com> parents: 139 diff changeset	972	)
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	973	{
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	974	ec_eeprom_sync_t *sync;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	975	ec_eeprom_pdo_t *pdo;
139 998215ab9b92 Laden der SDO-Subindizes. Florian Pose <fp@igh-essen.com> parents: 138 diff changeset	976	ec_eeprom_pdo_entry_t *pdo_entry;
135 80d493917205 Laden der SDO Dictionaries funktioniert. Florian Pose <fp@igh-essen.com> parents: 133 diff changeset	977	ec_sdo_t *sdo;
139 998215ab9b92 Laden der SDO-Subindizes. Florian Pose <fp@igh-essen.com> parents: 138 diff changeset	978	ec_sdo_entry_t *sdo_entry;
142 e933f1adb550 Link Status ausgelesen. Florian Pose <fp@igh-essen.com> parents: 140 diff changeset	979	int first, i;
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	980
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	981	if (slave->type) {
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	982	EC_INFO("%i) %s %s: %s\n", slave->ring_position,
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	983	slave->type->vendor_name, slave->type->product_name,
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	984	slave->type->description);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	985	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	986	else {
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	987	EC_INFO("%i) UNKNOWN SLAVE: vendor 0x%08X, product 0x%08X\n",
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	988	slave->ring_position, slave->sii_vendor_id,
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	989	slave->sii_product_code);
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	990	}
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	991
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	992	if (!verbosity) return;
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	993
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	994	EC_INFO(" Station address: 0x%04X\n", slave->station_address);
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	995
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	996	EC_INFO(" Data link status:\n");
183 8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	997	for (i = 0; i < 4; i++) {
190 4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	998	EC_INFO(" Port %i (", i);
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	999	switch (slave->sii_physical_layer[i]) {
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	1000	case 0x00:
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	1001	printk("EBUS");
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	1002	break;
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	1003	case 0x01:
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	1004	printk("100BASE-TX");
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	1005	break;
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	1006	case 0x02:
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	1007	printk("100BASE-FX");
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	1008	break;
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	1009	default:
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	1010	printk("unknown");
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	1011	}
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	1012	printk(")\n");
4e32bcc6b361 Now fetching port physical layer from EEPROM Florian Pose <fp@igh-essen.com> parents: 188 diff changeset	1013	EC_INFO(" link %s, loop %s, %s\n",
183 8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1014	slave->dl_link[i] ? "up" : "down",
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1015	slave->dl_loop[i] ? "closed" : "open",
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1016	slave->dl_signal[i] ? "signal detected" : "no signal");
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1017	}
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1018
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1019	EC_INFO(" Base information:\n");
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1020	EC_INFO(" Type %u, revision %i, build %i\n",
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1021	slave->base_type, slave->base_revision, slave->base_build);
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1022	EC_INFO(" Supported FMMUs: %i, sync managers: %i\n",
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1023	slave->base_fmmu_count, slave->base_sync_count);
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1024
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1025	if (slave->sii_mailbox_protocols) {
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1026	EC_INFO(" Mailbox communication:\n");
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1027	EC_INFO(" RX mailbox: 0x%04X/%i, TX mailbox: 0x%04X/%i\n",
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1028	slave->sii_rx_mailbox_offset, slave->sii_rx_mailbox_size,
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1029	slave->sii_tx_mailbox_offset, slave->sii_tx_mailbox_size);
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1030	EC_INFO(" Supported protocols: ");
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1031
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1032	first = 1;
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1033	if (slave->sii_mailbox_protocols & EC_MBOX_AOE) {
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1034	printk("AoE");
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1035	first = 0;
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1036	}
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1037	if (slave->sii_mailbox_protocols & EC_MBOX_EOE) {
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1038	if (!first) printk(", ");
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1039	printk("EoE");
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1040	first = 0;
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1041	}
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1042	if (slave->sii_mailbox_protocols & EC_MBOX_COE) {
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1043	if (!first) printk(", ");
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1044	printk("CoE");
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1045	first = 0;
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1046	}
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1047	if (slave->sii_mailbox_protocols & EC_MBOX_FOE) {
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1048	if (!first) printk(", ");
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1049	printk("FoE");
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1050	first = 0;
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1051	}
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1052	if (slave->sii_mailbox_protocols & EC_MBOX_SOE) {
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1053	if (!first) printk(", ");
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1054	printk("SoE");
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1055	first = 0;
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1056	}
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1057	if (slave->sii_mailbox_protocols & EC_MBOX_VOE) {
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1058	if (!first) printk(", ");
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1059	printk("VoE");
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1060	}
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1061	printk("\n");
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1062	}
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1063
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1064	EC_INFO(" EEPROM data:\n");
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1065
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1066	if (slave->sii_alias)
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1067	EC_INFO(" Configured station alias: 0x%04X (%i)\n",
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1068	slave->sii_alias, slave->sii_alias);
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1069
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1070	EC_INFO(" Vendor-ID: 0x%08X, Product code: 0x%08X\n",
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1071	slave->sii_vendor_id, slave->sii_product_code);
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1072	EC_INFO(" Revision number: 0x%08X, Serial number: 0x%08X\n",
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1073	slave->sii_revision_number, slave->sii_serial_number);
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1074
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1075	if (slave->eeprom_name)
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1076	EC_INFO(" Name: %s\n", slave->eeprom_name);
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1077	if (slave->eeprom_group)
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1078	EC_INFO(" Group: %s\n", slave->eeprom_group);
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1079	if (slave->eeprom_desc)
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1080	EC_INFO(" Description: %s\n", slave->eeprom_desc);
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1081
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1082	if (!list_empty(&slave->eeprom_syncs)) {
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1083	EC_INFO(" Sync-Managers:\n");
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1084	list_for_each_entry(sync, &slave->eeprom_syncs, list) {
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1085	EC_INFO(" %i: 0x%04X, length %i, control 0x%02X, %s\n",
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1086	sync->index, sync->physical_start_address,
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1087	sync->length, sync->control_register,
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1088	sync->enable ? "enable" : "disable");
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1089	}
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1090	}
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1091
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1092	list_for_each_entry(pdo, &slave->eeprom_pdos, list) {
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1093	EC_INFO(" %s \"%s\" (0x%04X), -> Sync-Manager %i\n",
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1094	pdo->type == EC_RX_PDO ? "RXPDO" : "TXPDO",
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1095	pdo->name ? pdo->name : "???",
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1096	pdo->index, pdo->sync_manager);
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1097
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1098	list_for_each_entry(pdo_entry, &pdo->entries, list) {
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1099	EC_INFO(" \"%s\" 0x%04X:%X, %i Bit\n",
147 a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1100	pdo_entry->name ? pdo_entry->name : "???",
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1101	pdo_entry->index, pdo_entry->subindex,
a355b587b4bc Ausgaben verbessert, Mini-Modul angepasst. Florian Pose <fp@igh-essen.com> parents: 145 diff changeset	1102	pdo_entry->bit_length);
140 b09658e50d6f Verbosity level in ecrt_master_print(). Florian Pose <fp@igh-essen.com> parents: 139 diff changeset	1103	}
b09658e50d6f Verbosity level in ecrt_master_print(). Florian Pose <fp@igh-essen.com> parents: 139 diff changeset	1104	}
b09658e50d6f Verbosity level in ecrt_master_print(). Florian Pose <fp@igh-essen.com> parents: 139 diff changeset	1105
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1106	if (verbosity < 2) return;
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1107
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1108	if (!list_empty(&slave->sdo_dictionary)) {
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1109	EC_INFO(" SDO-Dictionary:\n");
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1110	list_for_each_entry(sdo, &slave->sdo_dictionary, list) {
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1111	EC_INFO(" 0x%04X \"%s\"\n", sdo->index,
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1112	sdo->name ? sdo->name : "");
175 2e4b18203ade Altered CoE "Get object description response" fields Florian Pose <fp@igh-essen.com> parents: 164 diff changeset	1113	EC_INFO(" Object code: 0x%02X\n", sdo->object_code);
157 37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1114	list_for_each_entry(sdo_entry, &sdo->entries, list) {
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1115	EC_INFO(" 0x%04X:%i \"%s\", type 0x%04X, %i bits\n",
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1116	sdo->index, sdo_entry->subindex,
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1117	sdo_entry->name ? sdo_entry->name : "",
37c6dd0ff0b1 Bugfix: Crash after failing to fetch SDO dictionary. Florian Pose <fp@igh-essen.com> parents: 155 diff changeset	1118	sdo_entry->data_type, sdo_entry->bit_length);
139 998215ab9b92 Laden der SDO-Subindizes. Florian Pose <fp@igh-essen.com> parents: 138 diff changeset	1119	}
135 80d493917205 Laden der SDO Dictionaries funktioniert. Florian Pose <fp@igh-essen.com> parents: 133 diff changeset	1120	}
80d493917205 Laden der SDO Dictionaries funktioniert. Florian Pose <fp@igh-essen.com> parents: 133 diff changeset	1121	}
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	1122	}
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	1123
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	1124	/*****************************************************************************/
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	1125
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	1126	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1127	Outputs the values of the CRC faoult counters and resets them.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1128	\return 0 in case of success, else < 0
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1129	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1130
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1131	int ec_slave_check_crc(ec_slave_t slave /< EtherCAT slave /)
74 9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	1132	{
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1133	ec_command_t *command;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1134
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1135	command = &slave->master->simple_command;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1136
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1137	if (ec_command_nprd(command, slave->station_address, 0x0300, 4)) return -1;
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	1138	if (unlikely(ec_master_simple_io(slave->master, command))) {
89 e91ef35c36db Wiederholtes Senden, wenn keine Antwort. Florian Pose <fp@igh-essen.com> parents: 84 diff changeset	1139	EC_WARN("Reading CRC fault counters failed on slave %i!\n",
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	1140	slave->ring_position);
74 9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	1141	return -1;
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	1142	}
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	1143
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1144	if (!EC_READ_U32(command->data)) return 0; // no CRC faults
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1145
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1146	if (EC_READ_U8(command->data))
132 63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	1147	EC_WARN("%3i RX-error%s on slave %i, channel A.\n",
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1148	EC_READ_U8(command->data),
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1149	EC_READ_U8(command->data) == 1 ? "" : "s",
132 63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	1150	slave->ring_position);
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1151	if (EC_READ_U8(command->data + 1))
132 63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	1152	EC_WARN("%3i invalid frame%s on slave %i, channel A.\n",
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1153	EC_READ_U8(command->data + 1),
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1154	EC_READ_U8(command->data + 1) == 1 ? "" : "s",
132 63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	1155	slave->ring_position);
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1156	if (EC_READ_U8(command->data + 2))
132 63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	1157	EC_WARN("%3i RX-error%s on slave %i, channel B.\n",
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1158	EC_READ_U8(command->data + 2),
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1159	EC_READ_U8(command->data + 2) == 1 ? "" : "s",
132 63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	1160	slave->ring_position);
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1161	if (EC_READ_U8(command->data + 3))
132 63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	1162	EC_WARN("%3i invalid frame%s on slave %i, channel B.\n",
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1163	EC_READ_U8(command->data + 3),
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1164	EC_READ_U8(command->data + 3) == 1 ? "" : "s",
132 63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	1165	slave->ring_position);
74 9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	1166
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1167	// reset CRC counters
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1168	if (ec_command_npwr(command, slave->station_address, 0x0300, 4)) return -1;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 142 diff changeset	1169	EC_WRITE_U32(command->data, 0x00000000);
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: 144 diff changeset	1170	if (unlikely(ec_master_simple_io(slave->master, command))) {
89 e91ef35c36db Wiederholtes Senden, wenn keine Antwort. Florian Pose <fp@igh-essen.com> parents: 84 diff changeset	1171	EC_WARN("Resetting CRC fault counters failed on slave %i!\n",
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	1172	slave->ring_position);
74 9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	1173	return -1;
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	1174	}
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	1175
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	1176	return 0;
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	1177	}
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	1178
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	1179	/*****************************************************************************/
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	1180
133 b36d187ecc0b Unterst?tzte Prot. auslesen, Mailbox in Slave ausgelagert, Bugfix in Anzeige des Watch-Frames und erste SDO-List-Abfrage. Florian Pose <fp@igh-essen.com> parents: 132 diff changeset	1181	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1182	Writes the "configured station alias" to the slave's EEPROM.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1183	\return 0 in case of success, else < 0
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1184	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1185
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1186	int ecrt_slave_write_alias(ec_slave_t slave, /* EtherCAT slave */
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1187	uint16_t alias /** new alias */
138 7e743a61a991 SDO-Schnittstelle verbessert. Florian Pose <fp@igh-essen.com> parents: 136 diff changeset	1188	)
7e743a61a991 SDO-Schnittstelle verbessert. Florian Pose <fp@igh-essen.com> parents: 136 diff changeset	1189	{
7e743a61a991 SDO-Schnittstelle verbessert. Florian Pose <fp@igh-essen.com> parents: 136 diff changeset	1190	return ec_slave_sii_write16(slave, 0x0004, alias);
7e743a61a991 SDO-Schnittstelle verbessert. Florian Pose <fp@igh-essen.com> parents: 136 diff changeset	1191	}
7e743a61a991 SDO-Schnittstelle verbessert. Florian Pose <fp@igh-essen.com> parents: 136 diff changeset	1192
7e743a61a991 SDO-Schnittstelle verbessert. Florian Pose <fp@igh-essen.com> parents: 136 diff changeset	1193	/*****************************************************************************/
7e743a61a991 SDO-Schnittstelle verbessert. Florian Pose <fp@igh-essen.com> parents: 136 diff changeset	1194
182 8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	1195	/**
195 674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1196	Formats attribute data for SysFS read access.
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1197	\return number of bytes to read
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1198	*/
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1199
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1200	ssize_t ec_show_slave_attribute(struct kobject kobj, /< slave's kobject /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1201	struct attribute attr, /< attribute /
674071846ee3 Translated all comments and documentation to english language. Florian Pose <fp@igh-essen.com> parents: 190 diff changeset	1202	char buffer /< memory to store data /
182 8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	1203	)
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	1204	{
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	1205	ec_slave_t *slave = container_of(kobj, ec_slave_t, kobj);
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	1206
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	1207	if (attr == &attr_ring_position) {
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	1208	return sprintf(buffer, "%i\n", slave->ring_position);
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	1209	}
188 c0e49f4a1c07 Better calc. of coupler address; coupler address in SysFS; better output of ec_list Florian Pose <fp@igh-essen.com> parents: 185 diff changeset	1210	else if (attr == &attr_coupler_address) {
c0e49f4a1c07 Better calc. of coupler address; coupler address in SysFS; better output of ec_list Florian Pose <fp@igh-essen.com> parents: 185 diff changeset	1211	return sprintf(buffer, "%i:%i\n", slave->coupler_index,
c0e49f4a1c07 Better calc. of coupler address; coupler address in SysFS; better output of ec_list Florian Pose <fp@igh-essen.com> parents: 185 diff changeset	1212	slave->coupler_subindex);
183 8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1213	}
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1214	else if (attr == &attr_vendor_name) {
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1215	if (slave->type)
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1216	return sprintf(buffer, "%s\n", slave->type->vendor_name);
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1217	}
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1218	else if (attr == &attr_product_name) {
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1219	if (slave->type)
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1220	return sprintf(buffer, "%s\n", slave->type->product_name);
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1221	}
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1222	else if (attr == &attr_product_desc) {
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1223	if (slave->type)
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1224	return sprintf(buffer, "%s\n", slave->type->description);
8ae1e011e96c More slave fields in SysFS; DL link status for 4 ports Florian Pose <fp@igh-essen.com> parents: 182 diff changeset	1225	}
185 af570302dcee Slave (special) type in SysFS Florian Pose <fp@igh-essen.com> parents: 184 diff changeset	1226	else if (attr == &attr_type) {
af570302dcee Slave (special) type in SysFS Florian Pose <fp@igh-essen.com> parents: 184 diff changeset	1227	if (slave->type) {
af570302dcee Slave (special) type in SysFS Florian Pose <fp@igh-essen.com> parents: 184 diff changeset	1228	if (slave->type->special == EC_TYPE_BUS_COUPLER)
af570302dcee Slave (special) type in SysFS Florian Pose <fp@igh-essen.com> parents: 184 diff changeset	1229	return sprintf(buffer, "coupler\n");
af570302dcee Slave (special) type in SysFS Florian Pose <fp@igh-essen.com> parents: 184 diff changeset	1230	else
af570302dcee Slave (special) type in SysFS Florian Pose <fp@igh-essen.com> parents: 184 diff changeset	1231	return sprintf(buffer, "normal\n");
af570302dcee Slave (special) type in SysFS Florian Pose <fp@igh-essen.com> parents: 184 diff changeset	1232	}
af570302dcee Slave (special) type in SysFS Florian Pose <fp@igh-essen.com> parents: 184 diff changeset	1233	}
182 8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	1234
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	1235	return 0;
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	1236	}
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	1237
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	1238	/*****************************************************************************/
8c0bc99229a9 Slaves stored in list, slaves in SysFS Florian Pose <fp@igh-essen.com> parents: 175 diff changeset	1239
164 ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1240	const ec_code_msg_t al_status_messages[] = {
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1241	{0x0001, "Unspecified error"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1242	{0x0011, "Invalud requested state change"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1243	{0x0012, "Unknown requested state"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1244	{0x0013, "Bootstrap not supported"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1245	{0x0014, "No valid firmware"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1246	{0x0015, "Invalid mailbox configuration"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1247	{0x0016, "Invalid mailbox configuration"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1248	{0x0017, "Invalid sync manager configuration"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1249	{0x0018, "No valid inputs available"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1250	{0x0019, "No valid outputs"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1251	{0x001A, "Synchronisation error"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1252	{0x001B, "Sync manager watchdog"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1253	{0x0020, "Slave needs cold start"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1254	{0x0021, "Slave needs INIT"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1255	{0x0022, "Slave needs PREOP"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1256	{0x0023, "Slave needs SAVEOP"},
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1257	{}
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1258	};
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1259
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1260	/*****************************************************************************/
ed85368b2b2e AL status code reading after failed state transition. Florian Pose <fp@igh-essen.com> parents: 163 diff changeset	1261
138 7e743a61a991 SDO-Schnittstelle verbessert. Florian Pose <fp@igh-essen.com> parents: 136 diff changeset	1262	EXPORT_SYMBOL(ecrt_slave_write_alias);
7e743a61a991 SDO-Schnittstelle verbessert. Florian Pose <fp@igh-essen.com> parents: 136 diff changeset	1263
7e743a61a991 SDO-Schnittstelle verbessert. Florian Pose <fp@igh-essen.com> parents: 136 diff changeset	1264	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Thu, 20 Apr 2006 13:31:31 +0000
changeset 195	674071846ee3
parent 190	4e32bcc6b361
child 197	b9a6e2c22745
child 1618	5cff10efb927
permissions	-rw-r--r--