etherlabmaster: master/slave.c@b36d187ecc0b (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	*
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	5	* Methoden für einen EtherCAT-Slave.
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 *);
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	27
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	28	/*****************************************************************************/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	29
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	30	/**
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	31	EtherCAT-Slave-Konstruktor.
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	32	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	33
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	34	void ec_slave_init(ec_slave_t slave, /< EtherCAT-Slave /
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	35	ec_master_t master /< EtherCAT-Master /
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	36	)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	37	{
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	38	slave->master = master;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	39	slave->base_type = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	40	slave->base_revision = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	41	slave->base_build = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	42	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	43	slave->base_sync_count = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	44	slave->ring_position = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	45	slave->station_address = 0;
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	46	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	47	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	48	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	49	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	50	slave->sii_serial_number = 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	51	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	52	slave->type = NULL;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	53	slave->registered = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	54	slave->fmmu_count = 0;
121 1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	55	slave->eeprom_name = NULL;
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	56	slave->eeprom_group = NULL;
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	57	slave->eeprom_desc = NULL;
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	58	INIT_LIST_HEAD(&slave->eeprom_strings);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	59	INIT_LIST_HEAD(&slave->eeprom_syncs);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	60	INIT_LIST_HEAD(&slave->eeprom_pdos);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	61	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	62
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	63	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	64
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	65	/**
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	66	EtherCAT-Slave-Destruktor.
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	67	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	68
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	69	void ec_slave_clear(ec_slave_t slave /< EtherCAT-Slave /)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	70	{
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	71	ec_eeprom_string_t string, next_str;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	72	ec_eeprom_sync_t sync, next_sync;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	73	ec_eeprom_pdo_t pdo, next_pdo;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	74	ec_eeprom_pdo_entry_t entry, next_ent;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	75
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	76	// Alle Strings freigeben
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	77	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	78	list_del(&string->list);
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	79	kfree(string);
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	80	}
121 1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	81
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	82	// Alle Sync-Manager freigeben
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	83	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	84	list_del(&sync->list);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	85	kfree(sync);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	86	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	87
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	88	// Alle PDOs freigeben
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	89	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	90	list_del(&pdo->list);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	91	if (pdo->name) kfree(pdo->name);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	92
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	93	// Alle Entries innerhalb eines PDOs freigeben
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	94	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	95	list_del(&entry->list);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	96	if (entry->name) kfree(entry->name);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	97	kfree(entry);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	98	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	99
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	100	kfree(pdo);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	101	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	102
121 1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	103	if (slave->eeprom_name) kfree(slave->eeprom_name);
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	104	if (slave->eeprom_group) kfree(slave->eeprom_group);
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	105	if (slave->eeprom_desc) kfree(slave->eeprom_desc);
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	106	}
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	107
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	108	/*****************************************************************************/
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	109
1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	110	/**
122 132c3ffc8dea "kaputte" Umlaute korrigiert. Florian Pose <fp@igh-essen.com> parents: 121 diff changeset	111	Liest alle benötigten Informationen aus einem Slave.
91 0120d6214948 Code-Dokumentation angepasst. Florian Pose <fp@igh-essen.com> parents: 89 diff changeset	112
0120d6214948 Code-Dokumentation angepasst. Florian Pose <fp@igh-essen.com> parents: 89 diff changeset	113	\return 0 wenn alles ok, < 0 bei Fehler.
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	114	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	115
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	116	int ec_slave_fetch(ec_slave_t slave /< EtherCAT-Slave /)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	117	{
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	118	ec_command_t command;
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	119
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	120	// Read base data
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	121	ec_command_init_nprd(&command, slave->station_address, 0x0000, 6);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	122	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	123	EC_ERR("Reading base datafrom slave %i failed!\n",
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	124	slave->ring_position);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	125	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	126	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	127
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	128	slave->base_type = EC_READ_U8 (command.data);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	129	slave->base_revision = EC_READ_U8 (command.data + 1);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	130	slave->base_build = EC_READ_U16(command.data + 2);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	131	slave->base_fmmu_count = EC_READ_U8 (command.data + 4);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	132	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	133
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	134	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	135	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	136
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	137	// Read identification from "Slave Information Interface" (SII)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	138
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	139	if (unlikely(ec_slave_sii_read(slave, 0x0004,
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	140	(uint32_t *) &slave->sii_alias))) {
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	141	EC_ERR("Could not read SII alias!\n");
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	142	return -1;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	143	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	144
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	145	if (unlikely(ec_slave_sii_read(slave, 0x0008, &slave->sii_vendor_id))) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	146	EC_ERR("Could not read SII vendor id!\n");
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	147	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	148	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	149
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	150	if (unlikely(ec_slave_sii_read(slave, 0x000A, &slave->sii_product_code))) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	151	EC_ERR("Could not read SII product code!\n");
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	152	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	153	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	154
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	155	if (unlikely(ec_slave_sii_read(slave, 0x000C,
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	156	&slave->sii_revision_number))) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	157	EC_ERR("Could not read SII revision number!\n");
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	158	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	159	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	160
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	161	if (unlikely(ec_slave_sii_read(slave, 0x000E,
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	162	&slave->sii_serial_number))) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	163	EC_ERR("Could not read SII serial number!\n");
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	164	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	165	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	166
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	167	if (unlikely(ec_slave_sii_read(slave, 0x001C,
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	168	&slave->sii_mailbox_protocols))) {
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	169	EC_ERR("Could not read SII supported mailbox protocols!\n");
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	170	return -1;
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	171	}
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	172
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	173	if (unlikely(ec_slave_fetch_categories(slave))) {
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	174	EC_ERR("Could not fetch category data!\n");
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	175	return -1;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	176	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	177
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	178	return 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	179	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	180
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	181	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	182
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	183	/**
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	184	Liest Daten aus dem Slave-Information-Interface
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	185	eines EtherCAT-Slaves.
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	186
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	187	\return 0 bei Erfolg, sonst < 0
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	188	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	189
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	190	int ec_slave_sii_read(ec_slave_t *slave,
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	191	/*< EtherCAT-Slave /
101 b0c19892145a MERGE branches/async -r243:244 -> trunk (intypes). Florian Pose <fp@igh-essen.com> parents: 98 diff changeset	192	uint16_t offset,
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	193	/*< Adresse des zu lesenden SII-Registers /
101 b0c19892145a MERGE branches/async -r243:244 -> trunk (intypes). Florian Pose <fp@igh-essen.com> parents: 98 diff changeset	194	uint32_t *target
124 2a5d42513099 Nachmals verf?lschte Umlaute korrigiert. Florian Pose <fp@igh-essen.com> parents: 123 diff changeset	195	/**< Zeiger auf einen 4 Byte großen Speicher zum Ablegen
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	196	der Daten */
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	197	)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	198	{
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	199	ec_command_t command;
101 b0c19892145a MERGE branches/async -r243:244 -> trunk (intypes). Florian Pose <fp@igh-essen.com> parents: 98 diff changeset	200	uint8_t data[10];
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	201	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	202
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	203	// Initiate read operation
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	204
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	205	EC_WRITE_U8 (data, 0x00); // read-only access
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	206	EC_WRITE_U8 (data + 1, 0x01); // request read operation
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	207	EC_WRITE_U32(data + 2, offset);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	208
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	209	ec_command_init_npwr(&command, slave->station_address, 0x502, 6, data);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	210	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	211	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	212	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	213	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	214
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	215	// Der Slave legt die Informationen des Slave-Information-Interface
122 132c3ffc8dea "kaputte" Umlaute korrigiert. Florian Pose <fp@igh-essen.com> parents: 121 diff changeset	216	// in das Datenregister und löscht daraufhin ein Busy-Bit. Solange
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	217	// den Status auslesen, bis das Bit weg ist.
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	218
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	219	start = get_cycles();
119 b2de89096010 Verschiedene Timeouts verl?ngert. Florian Pose <fp@igh-essen.com> parents: 118 diff changeset	220	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	221
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	222	while (1)
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	223	{
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	224	udelay(10);
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	225
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	226	ec_command_init_nprd(&command, slave->station_address, 0x502, 10);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	227	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	228	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	229	slave->ring_position);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	230	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	231	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	232
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	233	end = get_cycles();
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	234
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	235	if (likely((EC_READ_U8(command.data + 1) & 0x81) == 0)) {
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	236	*target = EC_READ_U32(command.data + 6);
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	237	return 0;
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	238	}
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	239
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	240	if (unlikely((end - start) >= timeout)) {
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	241	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	242	return -1;
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	243	}
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	244	}
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	245	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	246
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	247	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	248
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	249	/**
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	250	Schreibt Daten in das Slave-Information-Interface
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	251	eines EtherCAT-Slaves.
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	252
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	253	\return 0 bei Erfolg, sonst < 0
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	254	*/
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	255
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	256	int ec_slave_sii_write(ec_slave_t *slave,
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	257	/*< EtherCAT-Slave /
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	258	uint16_t offset,
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	259	/*< Adresse des zu lesenden SII-Registers /
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	260	uint16_t value
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	261	/*< Zu schreibender Wert /
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	262	)
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	263	{
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	264	ec_command_t command;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	265	uint8_t data[8];
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	266	cycles_t start, end, timeout;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	267
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	268	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	269	slave->ring_position, offset, value);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	270
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	271	// Initiate write operation
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	272
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	273	EC_WRITE_U8 (data, 0x01); // enable write access
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	274	EC_WRITE_U8 (data + 1, 0x02); // request write operation
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	275	EC_WRITE_U32(data + 2, offset);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	276	EC_WRITE_U16(data + 6, value);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	277
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	278	ec_command_init_npwr(&command, slave->station_address, 0x502, 8, data);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	279	if (unlikely(ec_master_simple_io(slave->master, &command))) {
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	280	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	281	return -1;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	282	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	283
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	284	// Der Slave legt die Informationen des Slave-Information-Interface
122 132c3ffc8dea "kaputte" Umlaute korrigiert. Florian Pose <fp@igh-essen.com> parents: 121 diff changeset	285	// in das Datenregister und löscht daraufhin ein Busy-Bit. Solange
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	286	// den Status auslesen, bis das Bit weg ist.
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	287
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	288	start = get_cycles();
119 b2de89096010 Verschiedene Timeouts verl?ngert. Florian Pose <fp@igh-essen.com> parents: 118 diff changeset	289	timeout = (cycles_t) 100 * cpu_khz; // 100ms
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	290
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	291	while (1)
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	292	{
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	293	udelay(10);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	294
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	295	ec_command_init_nprd(&command, slave->station_address, 0x502, 2);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	296	if (unlikely(ec_master_simple_io(slave->master, &command))) {
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	297	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	298	slave->ring_position);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	299	return -1;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	300	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	301
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	302	end = get_cycles();
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	303
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	304	if (likely((EC_READ_U8(command.data + 1) & 0x82) == 0)) {
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	305	if (EC_READ_U8(command.data + 1) & 0x40) {
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	306	EC_ERR("SII-write failed!\n");
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	307	return -1;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	308	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	309	else {
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	310	EC_INFO("SII-write succeeded!\n");
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	311	return 0;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	312	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	313	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	314
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	315	if (unlikely((end - start) >= timeout)) {
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	316	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	317	return -1;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	318	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	319	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	320	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	321
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	322	/*****************************************************************************/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	323
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	324	/**
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	325	Holt Daten aus dem EEPROM.
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	326
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	327	\return 0, wenn alles ok, sonst < 0
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	328	*/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	329
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	330	int ec_slave_fetch_categories(ec_slave_t slave /< EtherCAT-Slave /)
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	331	{
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	332	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	333	uint32_t value;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	334	uint8_t *cat_data;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	335	unsigned int i;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	336
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	337	word_offset = 0x0040;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	338
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	339	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	340	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	341	return -1;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	342	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	343
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	344	while (1) {
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	345	// read category type
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	346	if (ec_slave_sii_read(slave, word_offset, &value)) {
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	347	EC_ERR("Unable to read category header.\n");
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	348	goto out_free;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	349	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	350
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	351	// Last category?
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	352	if ((value & 0xFFFF) == 0xFFFF) break;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	353
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	354	cat_type = value & 0x7FFF;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	355	word_count = (value >> 16) & 0xFFFF;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	356
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	357	// Fetch category data
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	358	for (i = 0; i < word_count; i++) {
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	359	if (ec_slave_sii_read(slave, word_offset + 2 + i, &value)) {
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	360	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	361	goto out_free;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	362	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	363
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	364	cat_data[i * 2] = (value >> 0) & 0xFF;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	365	cat_data[i * 2 + 1] = (value >> 8) & 0xFF;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	366
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	367	// read second word "on the fly"
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	368	if (i + 1 < word_count) {
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	369	i++;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	370	cat_data[i * 2] = (value >> 16) & 0xFF;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	371	cat_data[i * 2 + 1] = (value >> 24) & 0xFF;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	372	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	373	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	374
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	375	switch (cat_type)
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	376	{
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	377	case 0x000A:
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	378	if (ec_slave_fetch_strings(slave, cat_data))
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	379	goto out_free;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	380	break;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	381	case 0x001E:
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	382	if (ec_slave_fetch_general(slave, cat_data))
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	383	goto out_free;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	384	break;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	385	case 0x0028:
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	386	break;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	387	case 0x0029:
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	388	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	389	goto out_free;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	390	break;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	391	case 0x0032:
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	392	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	393	goto out_free;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	394	break;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	395	case 0x0033:
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	396	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	397	goto out_free;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	398	break;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	399	default:
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	400	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	401	cat_type, slave->ring_position);
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	402	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	403
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	404	word_offset += 2 + word_count;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	405	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	406
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	407	kfree(cat_data);
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	408	return 0;
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	409
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	410	out_free:
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	411	kfree(cat_data);
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	412	return -1;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	413	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	414
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	415	/*****************************************************************************/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	416
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	417	/**
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	418	Holt die Daten einer String-Kategorie.
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	419
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	420	\return 0 wenn alles ok, sonst < 0
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	421	*/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	422
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	423	int ec_slave_fetch_strings(ec_slave_t slave, /< EtherCAT-Slave /
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	424	const uint8_t data /< Kategoriedaten /
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	425	)
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	426	{
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	427	unsigned int string_count, i;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	428	size_t size;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	429	off_t offset;
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	430	ec_eeprom_string_t *string;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	431
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	432	string_count = data[0];
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	433	offset = 1;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	434	for (i = 0; i < string_count; i++) {
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	435	size = data[offset];
122 132c3ffc8dea "kaputte" Umlaute korrigiert. Florian Pose <fp@igh-essen.com> parents: 121 diff changeset	436	// Speicher für String-Objekt und Daten in einem Rutsch allozieren
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	437	if (!(string = (ec_eeprom_string_t *)
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	438	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	439	EC_ERR("Failed to allocate string memory.\n");
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	440	return -1;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	441	}
121 1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	442	string->size = size;
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	443	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	444	memcpy(string->data, data + offset + 1, size);
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	445	string->data[size] = 0x00;
121 1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	446	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	447	offset += 1 + size;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	448	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	449
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	450	return 0;
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	451	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	452
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	453	/*****************************************************************************/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	454
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	455	/**
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	456	Holt die Daten einer General-Kategorie.
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	457	*/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	458
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	459	int ec_slave_fetch_general(ec_slave_t slave, /< EtherCAT-Slave /
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	460	const uint8_t data /< Kategorie-Daten /
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	461	)
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	462	{
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	463	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	464	return -1;
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	465	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	466	return -1;
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	467	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	468	return -1;
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	469
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	470	return 0;
118 dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	471	}
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	472
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	473	/*****************************************************************************/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	474
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	475	/**
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	476	Holt die Daten einer Sync-Manager-Kategorie.
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	477	*/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	478
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	479	int ec_slave_fetch_sync(ec_slave_t slave, /< EtherCAT-Slave /
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	480	const uint8_t data, /< Kategorie-Daten /
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	481	size_t word_count /*< Anzahl Words /
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	482	)
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	483	{
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	484	unsigned int sync_count, i;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	485	ec_eeprom_sync_t *sync;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	486
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	487	sync_count = word_count / 4; // Sync-Manager-Strunktur ist 4 Worte lang
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	488
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	489	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	490	if (!(sync = (ec_eeprom_sync_t *)
e67c80a76de4 Code aufger?umt und kleines Speicherleck entdeckt. Florian Pose <fp@igh-essen.com> parents: 126 diff changeset	491	kmalloc(sizeof(ec_eeprom_sync_t), GFP_KERNEL))) {
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	492	EC_ERR("Failed to allocate Sync-Manager memory.\n");
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	493	return -1;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	494	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	495
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	496	sync->index = i;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	497	sync->physical_start_address = ((uint16_t ) (data + 0));
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	498	sync->length = ((uint16_t ) (data + 2));
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	499	sync->control_register = data[4];
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	500	sync->enable = data[6];
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	501
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	502	list_add_tail(&sync->list, &slave->eeprom_syncs);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	503	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	504
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	505	return 0;
118 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
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	508	/*****************************************************************************/
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	/**
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	511	Holt die Daten einer TXPDO-Kategorie.
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	512	*/
dc71ce4cc641 Kategorie-Daten aus EEPROM lesen. Florian Pose <fp@igh-essen.com> parents: 114 diff changeset	513
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	514	int ec_slave_fetch_pdo(ec_slave_t slave, /< EtherCAT-Slave /
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	515	const uint8_t data, /< Kategorie-Daten /
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	516	size_t word_count, /*< Anzahl Worte /
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	517	ec_pdo_type_t pdo_type /*< PDO-Typ /
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	518	)
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	519	{
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	520	ec_eeprom_pdo_t *pdo;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	521	ec_eeprom_pdo_entry_t *entry;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	522	unsigned int entry_count, i;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	523
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	524	while (word_count >= 4) {
127 e67c80a76de4 Code aufger?umt und kleines Speicherleck entdeckt. Florian Pose <fp@igh-essen.com> parents: 126 diff changeset	525	if (!(pdo = (ec_eeprom_pdo_t *)
e67c80a76de4 Code aufger?umt und kleines Speicherleck entdeckt. Florian Pose <fp@igh-essen.com> parents: 126 diff changeset	526	kmalloc(sizeof(ec_eeprom_pdo_t), GFP_KERNEL))) {
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	527	EC_ERR("Failed to allocate PDO memory.\n");
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	528	return -1;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	529	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	530
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	531	INIT_LIST_HEAD(&pdo->entries);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	532	pdo->type = pdo_type;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	533
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	534	pdo->index = ((uint16_t ) data);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	535	entry_count = data[2];
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	536	pdo->sync_manager = data[3];
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	537	pdo->name = NULL;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	538	ec_slave_locate_string(slave, data[5], &pdo->name);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	539
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	540	list_add_tail(&pdo->list, &slave->eeprom_pdos);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	541
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	542	word_count -= 4;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	543	data += 8;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	544
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	545	for (i = 0; i < entry_count; i++) {
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	546	if (!(entry = (ec_eeprom_pdo_entry_t *)
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	547	kmalloc(sizeof(ec_eeprom_pdo_entry_t), GFP_KERNEL))) {
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	548	EC_ERR("Failed to allocate PDO entry memory.\n");
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	549	return -1;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	550	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	551
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	552	entry->index = ((uint16_t ) data);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	553	entry->subindex = data[2];
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	554	entry->name = NULL;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	555	ec_slave_locate_string(slave, data[3], &entry->name);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	556	entry->bit_length = data[5];
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	557
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	558	list_add_tail(&entry->list, &pdo->entries);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	559
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	560	word_count -= 4;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	561	data += 8;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	562	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	563	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	564
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	565	return 0;
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	566	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	567
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	568	/*****************************************************************************/
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	569
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	570	/**
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	571	Durchsucht die temporären Strings und dupliziert den gefundenen String.
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	572	*/
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	573
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	574	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	575	{
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	576	ec_eeprom_string_t *string;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	577	char *err_string;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	578
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	579	// Erst alten Speicher freigeben
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	580	if (*ptr) {
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	581	kfree(*ptr);
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	582	*ptr = NULL;
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	583	}
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	584
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	585	// Index 0 bedeutet "nicht belegt"
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	586	if (!index) return 0;
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	587
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	588	// EEPROM-String mit Index finden und kopieren
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	589	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	590	if (--index) continue;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	591
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	592	if (!(ptr = (char ) kmalloc(string->size + 1, GFP_KERNEL))) {
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	593	EC_ERR("Unable to allocate string memory.\n");
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	594	return -1;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	595	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	596	memcpy(*ptr, string->data, string->size + 1);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	597	return 0;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	598	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	599
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	600	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	601
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	602	err_string = "(string not found)";
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	603
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	604	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	605	EC_ERR("Unable to allocate string memory.\n");
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	606	return -1;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	607	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	608
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	609	memcpy(*ptr, err_string, strlen(err_string) + 1);
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	610	return 0;
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	611	}
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	612
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	613	/*****************************************************************************/
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	614
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	615	/**
122 132c3ffc8dea "kaputte" Umlaute korrigiert. Florian Pose <fp@igh-essen.com> parents: 121 diff changeset	616	Bestätigt einen Fehler beim Zustandswechsel.
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	617
91 0120d6214948 Code-Dokumentation angepasst. Florian Pose <fp@igh-essen.com> parents: 89 diff changeset	618	\todo Funktioniert noch nicht...
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	619	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	620
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	621	void ec_slave_state_ack(ec_slave_t *slave,
122 132c3ffc8dea "kaputte" Umlaute korrigiert. Florian Pose <fp@igh-essen.com> parents: 121 diff changeset	622	/*< Slave, dessen Zustand geändert werden soll /
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	623	uint8_t state
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	624	/*< Alter Zustand /
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	625	)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	626	{
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	627	ec_command_t command;
101 b0c19892145a MERGE branches/async -r243:244 -> trunk (intypes). Florian Pose <fp@igh-essen.com> parents: 98 diff changeset	628	uint8_t data[2];
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	629	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	630
77 677967864795 EC_READ/WRITE-Makros verwenden Makros aud asm/byteorder.h und werden konsequent verwendet. Florian Pose <fp@igh-essen.com> parents: 74 diff changeset	631	EC_WRITE_U16(data, state \| EC_ACK);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	632
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	633	ec_command_init_npwr(&command, slave->station_address, 0x0120, 2, data);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	634	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	635	EC_WARN("State %02X acknowledge failed on slave %i!\n",
e91ef35c36db Wiederholtes Senden, wenn keine Antwort. Florian Pose <fp@igh-essen.com> parents: 84 diff changeset	636	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	637	return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	638	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	639
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	640	start = get_cycles();
119 b2de89096010 Verschiedene Timeouts verl?ngert. Florian Pose <fp@igh-essen.com> parents: 118 diff changeset	641	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	642
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	643	while (1)
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	644	{
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	645	udelay(100); // Dem Slave etwas Zeit lassen...
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	646
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	647	ec_command_init_nprd(&command, slave->station_address, 0x0130, 2);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	648	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	649	EC_WARN("State %02X acknowledge checking failed on slave %i!\n",
e91ef35c36db Wiederholtes Senden, wenn keine Antwort. Florian Pose <fp@igh-essen.com> parents: 84 diff changeset	650	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	651	return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	652	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	653
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	654	end = get_cycles();
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	655
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	656	if (unlikely(EC_READ_U8(command.data) != state)) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	657	EC_WARN("Could not acknowledge state %02X on slave %i (code"
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	658	" %02X)!\n", state, slave->ring_position,
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	659	EC_READ_U8(command.data));
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	660	return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	661	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	662
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	663	if (likely(EC_READ_U8(command.data) == state)) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	664	EC_INFO("Acknowleged state %02X on slave %i.\n", state,
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	665	slave->ring_position);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	666	return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	667	}
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	668
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	669	if (unlikely((end - start) >= timeout)) {
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	670	EC_WARN("Could not check state acknowledgement %02X of slave %i -"
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	671	" Timeout while checking!\n", state, slave->ring_position);
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	672	return;
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	673	}
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	674	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	675	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	676
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	677	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	678
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	679	/**
122 132c3ffc8dea "kaputte" Umlaute korrigiert. Florian Pose <fp@igh-essen.com> parents: 121 diff changeset	680	Ändert den Zustand eines Slaves.
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	681
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	682	\return 0 bei Erfolg, sonst < 0
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	683	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	684
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	685	int ec_slave_state_change(ec_slave_t *slave,
122 132c3ffc8dea "kaputte" Umlaute korrigiert. Florian Pose <fp@igh-essen.com> parents: 121 diff changeset	686	/*< Slave, dessen Zustand geändert werden soll /
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	687	uint8_t state
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	688	/*< Neuer Zustand /
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	689	)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	690	{
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	691	ec_command_t command;
101 b0c19892145a MERGE branches/async -r243:244 -> trunk (intypes). Florian Pose <fp@igh-essen.com> parents: 98 diff changeset	692	uint8_t data[2];
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	693	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	694
77 677967864795 EC_READ/WRITE-Makros verwenden Makros aud asm/byteorder.h und werden konsequent verwendet. Florian Pose <fp@igh-essen.com> parents: 74 diff changeset	695	EC_WRITE_U16(data, state);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	696
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	697	ec_command_init_npwr(&command, slave->station_address, 0x0120, 2, data);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	698	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	699	EC_ERR("Failed to set state %02X on slave %i!\n",
e91ef35c36db Wiederholtes Senden, wenn keine Antwort. Florian Pose <fp@igh-essen.com> parents: 84 diff changeset	700	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	701	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	702	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	703
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	704	start = get_cycles();
119 b2de89096010 Verschiedene Timeouts verl?ngert. Florian Pose <fp@igh-essen.com> parents: 118 diff changeset	705	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	706
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	707	while (1)
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	708	{
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	709	udelay(100); // Dem Slave etwas Zeit lassen...
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	710
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	711	ec_command_init_nprd(&command, slave->station_address, 0x0130, 2);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	712	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	713	EC_ERR("Failed to check state %02X on slave %i!\n",
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	714	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	715	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	716	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	717
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	718	end = get_cycles();
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	719
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	720	if (unlikely(EC_READ_U8(command.data) & 0x10)) { // State change error
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	721	EC_ERR("Could not set state %02X - Slave %i refused state change"
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	722	" (code %02X)!\n", state, slave->ring_position,
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	723	EC_READ_U8(command.data));
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	724	ec_slave_state_ack(slave, EC_READ_U8(command.data) & 0x0F);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	725	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	726	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	727
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	728	if (likely(EC_READ_U8(command.data) == (state & 0x0F))) {
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	729	// State change successful
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	730	return 0;
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	731	}
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	732
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	733	if (unlikely((end - start) >= timeout)) {
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	734	EC_ERR("Could not check state %02X of slave %i - Timeout!\n",
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	735	state, slave->ring_position);
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	736	return -1;
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	737	}
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	738	}
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	739	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	740
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	741	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	742
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	743	/**
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	744	Merkt eine FMMU-Konfiguration vor.
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	745
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	746	Die FMMU wird so konfiguriert, dass sie den gesamten Datenbereich des
122 132c3ffc8dea "kaputte" Umlaute korrigiert. Florian Pose <fp@igh-essen.com> parents: 121 diff changeset	747	entsprechenden Sync-Managers abdeckt. Für jede Domäne werden separate
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	748	FMMUs konfiguriert.
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	749
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	750	Wenn die entsprechende FMMU bereits konfiguriert ist, wird dies als
122 132c3ffc8dea "kaputte" Umlaute korrigiert. Florian Pose <fp@igh-essen.com> parents: 121 diff changeset	751	Erfolg zurückgegeben.
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	752
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	753	\return 0 bei Erfolg, sonst < 0
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	754	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	755
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	756	int ec_slave_set_fmmu(ec_slave_t slave, /< EtherCAT-Slave /
122 132c3ffc8dea "kaputte" Umlaute korrigiert. Florian Pose <fp@igh-essen.com> parents: 121 diff changeset	757	const ec_domain_t domain, /< Domäne /
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	758	const ec_sync_t sync /< Sync-Manager /
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	759	)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	760	{
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	761	unsigned int i;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	762
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	763	// FMMU schon vorgemerkt?
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	764	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	765	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	766	return 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	767
91 0120d6214948 Code-Dokumentation angepasst. Florian Pose <fp@igh-essen.com> parents: 89 diff changeset	768	// Neue FMMU reservieren...
0120d6214948 Code-Dokumentation angepasst. Florian Pose <fp@igh-essen.com> parents: 89 diff changeset	769
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	770	if (slave->fmmu_count >= slave->base_fmmu_count) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	771	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	772	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	773	}
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	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	776	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	777	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	778	slave->fmmu_count++;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	779	slave->registered = 1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	780
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	781	return 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	782	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	783
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	784	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	785
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	786	/**
122 132c3ffc8dea "kaputte" Umlaute korrigiert. Florian Pose <fp@igh-essen.com> parents: 121 diff changeset	787	Gibt alle Informationen über einen EtherCAT-Slave aus.
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	788	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	789
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	790	void ec_slave_print(const ec_slave_t slave /< EtherCAT-Slave /)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	791	{
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	792	ec_eeprom_sync_t *sync;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	793	ec_eeprom_pdo_t *pdo;
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	794	ec_eeprom_pdo_entry_t *entry;
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	795	int first;
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	796
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	797	EC_INFO("x-- EtherCAT slave information ---------------\n");
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	798
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	799	if (slave->type) {
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	800	EC_INFO("\| Vendor \"%s\", Product \"%s\": %s\n",
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	801	slave->type->vendor_name, slave->type->product_name,
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	802	slave->type->description);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	803	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	804	else {
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	805	EC_INFO("\| * This slave has no type information! *\n");
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	806	}
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	807
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	808	EC_INFO("\| Ring position: %i, Station address: 0x%04X\n",
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	809	slave->ring_position, slave->station_address);
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	810
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	811	EC_INFO("\| Base information:\n");
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	812	EC_INFO("\| Type %u, Revision %i, Build %i\n",
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	813	slave->base_type, slave->base_revision, slave->base_build);
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	814	EC_INFO("\| Supported FMMUs: %i, Sync managers: %i\n",
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	815	slave->base_fmmu_count, slave->base_sync_count);
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	816
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	817	EC_INFO("\| Supported mailbox protocols: ");
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	818	if (!slave->sii_mailbox_protocols) {
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	819	printk("(none)");
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	820	}
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	821	else {
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	822	first = 1;
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	823	if (slave->sii_mailbox_protocols & EC_MBOX_AOE) {
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	824	printk("AoE");
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	825	first = 0;
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	826	}
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	827	if (slave->sii_mailbox_protocols & EC_MBOX_EOE) {
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	828	if (!first) printk(", ");
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	829	printk("EoE");
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	830	first = 0;
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	831	}
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	832	if (slave->sii_mailbox_protocols & EC_MBOX_COE) {
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	833	if (!first) printk(", ");
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	834	printk("CoE");
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	835	first = 0;
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	836	}
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	837	if (slave->sii_mailbox_protocols & EC_MBOX_FOE) {
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	838	if (!first) printk(", ");
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	839	printk("FoE");
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	840	first = 0;
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	841	}
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	842	if (slave->sii_mailbox_protocols & EC_MBOX_SOE) {
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	843	if (!first) printk(", ");
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	844	printk("SoE");
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	845	first = 0;
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	846	}
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	847	if (slave->sii_mailbox_protocols & EC_MBOX_VOE) {
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	848	if (!first) printk(", ");
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	849	printk("VoE");
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	850	}
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	851	}
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	852	printk("\n");
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	853
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	854	EC_INFO("\| EEPROM data:\n");
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	855
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	856	if (slave->sii_alias)
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	857	EC_INFO("\| Configured station alias: 0x%04X (%i)\n",
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	858	slave->sii_alias, slave->sii_alias);
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	859
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	860	EC_INFO("\| Vendor-ID: 0x%08X, Product code: 0x%08X\n",
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	861	slave->sii_vendor_id, slave->sii_product_code);
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	862	EC_INFO("\| Revision number: 0x%08X, Serial number: 0x%08X\n",
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	863	slave->sii_revision_number, slave->sii_serial_number);
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	864
121 1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	865	if (slave->eeprom_name)
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	866	EC_INFO("\| Name: %s\n", slave->eeprom_name);
121 1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	867	if (slave->eeprom_group)
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	868	EC_INFO("\| Group: %s\n", slave->eeprom_group);
121 1cd6f7a47b72 Bugfix: Absturz behoben, EEPROM-Infos. Florian Pose <fp@igh-essen.com> parents: 119 diff changeset	869	if (slave->eeprom_desc)
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	870	EC_INFO("\| Description: %s\n", slave->eeprom_desc);
126 bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	871
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	872	if (!list_empty(&slave->eeprom_syncs)) {
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	873	EC_INFO("\| Sync-Managers:\n");
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	874	list_for_each_entry(sync, &slave->eeprom_syncs, list) {
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	875	EC_INFO("\| %i: 0x%04X, length %i, control 0x%02X, %s\n",
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	876	sync->index, sync->physical_start_address, sync->length,
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	877	sync->control_register,
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	878	sync->enable ? "enable" : "disable");
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	879	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	880	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	881
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	882	list_for_each_entry(pdo, &slave->eeprom_pdos, list) {
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	883	EC_INFO("\| %s \"%s\" (0x%04X), -> Sync-Manager %i\n",
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	884	pdo->type == EC_RX_PDO ? "RXPDO" : "TXPDO",
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	885	pdo->name ? pdo->name : "???",
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	886	pdo->index, pdo->sync_manager);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	887
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	888	list_for_each_entry(entry, &pdo->entries, list) {
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	889	EC_INFO("\| \"%s\" 0x%04X:%X, %i Bit\n",
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	890	entry->name ? entry->name : "???",
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	891	entry->index, entry->subindex, entry->bit_length);
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	892	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	893	}
bbc963b9fead Restliche EEPROM-Daten ausgelesen. Florian Pose <fp@igh-essen.com> parents: 124 diff changeset	894
123 4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	895	EC_INFO("x---------------------------------------------\n");
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	896	}
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	897
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	898	/*****************************************************************************/
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	899
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	900	/**
4d5dc58d48e2 Weitere EEPROM-Daten. Florian Pose <fp@igh-essen.com> parents: 122 diff changeset	901	Gibt die Zählerstände der CRC-Fault-Counter aus und setzt diese zurück.
74 9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	902
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	903	\return 0 bei Erfolg, sonst < 0
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	904	*/
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	905
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	906	int ec_slave_check_crc(ec_slave_t slave /< EtherCAT-Slave /)
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	907	{
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	908	ec_command_t command;
74 9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	909	uint8_t data[4];
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	910
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	911	ec_command_init_nprd(&command, slave->station_address, 0x0300, 4);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	912	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	913	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	914	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	915	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	916	}
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	917
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	918	// No CRC faults.
132 63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	919	if (!EC_READ_U32(command.data)) return 0;
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	920
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	921	if (EC_READ_U8(command.data))
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	922	EC_WARN("%3i RX-error%s on slave %i, channel A.\n",
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	923	EC_READ_U8(command.data),
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	924	EC_READ_U8(command.data) == 1 ? "" : "s",
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	925	slave->ring_position);
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	926	if (EC_READ_U8(command.data + 1))
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	927	EC_WARN("%3i invalid frame%s on slave %i, channel A.\n",
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	928	EC_READ_U8(command.data + 1),
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	929	EC_READ_U8(command.data + 1) == 1 ? "" : "s",
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	930	slave->ring_position);
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	931	if (EC_READ_U8(command.data + 2))
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	932	EC_WARN("%3i RX-error%s on slave %i, channel B.\n",
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	933	EC_READ_U8(command.data + 2),
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	934	EC_READ_U8(command.data + 2) == 1 ? "" : "s",
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	935	slave->ring_position);
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	936	if (EC_READ_U8(command.data + 3))
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	937	EC_WARN("%3i invalid frame%s on slave %i, channel B.\n",
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	938	EC_READ_U8(command.data + 3),
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	939	EC_READ_U8(command.data + 3) == 1 ? "" : "s",
63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	940	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	941
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	942	// Reset CRC counters
132 63a5b40eb7da CRC-Counter nach ESC-Datasheet implementiert. Florian Pose <fp@igh-essen.com> parents: 127 diff changeset	943	EC_WRITE_U32(data, 0x00000000);
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	944	ec_command_init_npwr(&command, slave->station_address, 0x0300, 4, data);
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	945	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	946	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	947	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	948	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	949	}
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	950
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	951	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	952	}
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	953
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	954	/*****************************************************************************/
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	955
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	956	/**
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	957	Sendet ein Mailbox-Kommando.
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	958	*/
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	959
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	960	int ec_slave_mailbox_send(ec_slave_t slave, /< EtherCAT-Slave /
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	961	uint8_t type, /*< Unterliegendes Protokoll /
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	962	const uint8_t prot_data, /< Protokoll-Daten /
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	963	size_t size /*< Datengröße /
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	964	)
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	965	{
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	966	uint8_t data[0xF6];
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	967	ec_command_t command;
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	968
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	969	if (unlikely(size + 6 > 0xF6)) {
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	970	EC_ERR("Data size does not fit in mailbox!\n");
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	971	return -1;
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	972	}
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	973
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	974	memset(data, 0x00, 0xF6);
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	975
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	976	EC_WRITE_U16(data, size); // Length of the Mailbox service data
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	977	EC_WRITE_U16(data + 2, slave->station_address); // Station address
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	978	EC_WRITE_U8 (data + 4, 0x00); // Channel & priority
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	979	EC_WRITE_U8 (data + 5, type); // Underlying protocol type
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	980
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	981	memcpy(data + 6, prot_data, size);
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	982
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	983	ec_command_init_npwr(&command, slave->station_address, 0x1800, 0xF6, data);
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	984	if (unlikely(ec_master_simple_io(slave->master, &command))) {
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	985	EC_ERR("Mailbox sending failed on slave %i!\n", slave->ring_position);
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	986	return -1;
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	987	}
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	988
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	989	return 0;
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	990	}
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	991
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	992	/*****************************************************************************/
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	993
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	994	/**
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	995	Sendet ein Mailbox-Kommando.
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	996	*/
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	997
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	998	int ec_slave_mailbox_receive(ec_slave_t slave, /< EtherCAT-Slave /
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	999	uint8_t type, /*< Unterliegendes Protokoll /
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	1000	uint8_t prot_data, /< Protokoll-Daten /
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	1001	size_t size /*< Datengröße des Puffers, später
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	1002	Größe der gelesenen Daten */
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	1003	)
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	1004	{
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	1005	ec_command_t command;
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	1006	size_t data_size;
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	1007	cycles_t start, end, timeout;
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	1008
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	1009	// Read "written bit" of Sync-Manager
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	1010	start = get_cycles();
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	1011	timeout = (cycles_t) 100 * cpu_khz; // 100ms
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	1012
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	1013	while (1)
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	1014	{
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	1015	ec_command_init_nprd(&command, slave->station_address, 0x808, 8);
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	1016	if (unlikely(ec_master_simple_io(slave->master, &command))) {
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	1017	EC_ERR("Mailbox checking failed on slave %i!\n",
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	1018	slave->ring_position);
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	1019	return -1;
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	1020	}
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	1021
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	1022	end = get_cycles();
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	1023
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	1024	if (EC_READ_U8(command.data + 5) & 8) break; // Written bit is high
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	1025
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	1026	if ((end - start) >= timeout) {
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	1027	EC_ERR("Mailbox check - Slave %i timed out.\n",
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	1028	slave->ring_position);
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	1029	return -1;
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	1030	}
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	1031
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	1032	udelay(100);
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	1033	}
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	1034
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	1035	if (unlikely(slave->master->debug_level) > 1)
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	1036	EC_DBG("SDO download took %ius.\n", ((u32) (end - start) * 1000
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	1037	/ cpu_khz));
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	1038
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	1039	ec_command_init_nprd(&command, slave->station_address, 0x18F6, 0xF6);
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	1040	if (unlikely(ec_master_simple_io(slave->master, &command))) {
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	1041	EC_ERR("Mailbox receiving failed on slave %i!\n",
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	1042	slave->ring_position);
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	1043	return -1;
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	1044	}
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	1045
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	1046	if (EC_READ_U8(command.data + 5) != type) { // nicht CoE
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	1047	EC_ERR("Invalid mailbox response (non-CoE) at slave %i!\n",
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	1048	slave->ring_position);
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	1049	return -1;
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	1050	}
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	1051
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	1052	if ((data_size = EC_READ_U16(command.data)) > *size) {
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	1053	EC_ERR("CoE data does not fit in buffer (%i > %i).\n",
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	1054	data_size, *size);
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	1055	return -1;
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	1056	}
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	1057
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	1058	memcpy(prot_data, command.data + 6, data_size);
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	1059	*size = data_size;
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	1060	return 0;
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	1061	}
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	1062
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	1063	/*****************************************************************************/
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	1064
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1065	/* Emacs-Konfiguration
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1066	;;; Local Variables: ***
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	1067	;;; c-basic-offset:4 ***
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1068	;;; End: ***
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1069	*/
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	1070

author	Florian Pose <fp@igh-essen.com>
	Mon, 27 Mar 2006 15:52:08 +0000
changeset 133	b36d187ecc0b
parent 132	63a5b40eb7da
child 135	80d493917205
permissions	-rw-r--r--