etherlabmaster: master/slave.c@e4b4b5a85e75 (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	*
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	5	* Methoden für einen EtherCAT-Slave.
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
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	21	/**
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	22	EtherCAT-Slave-Konstruktor.
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	23	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	24
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	25	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	26	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	27	)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	28	{
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	29	slave->master = master;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	30	slave->base_type = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	31	slave->base_revision = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	32	slave->base_build = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	33	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	34	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	35	slave->ring_position = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	36	slave->station_address = 0;
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	37	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	38	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	39	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	40	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	41	slave->sii_serial_number = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	42	slave->type = NULL;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	43	slave->registered = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	44	slave->fmmu_count = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	45	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	46
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	47	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	48
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	49	/**
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	50	EtherCAT-Slave-Destruktor.
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	51	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	52
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	53	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	54	{
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	55	// Nichts freizugeben
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	56	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	57
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	58	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	59
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	60	/**
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	61	Liest alle benötigten Informationen aus einem Slave.
91 0120d6214948 Code-Dokumentation angepasst. Florian Pose <fp@igh-essen.com> parents: 89 diff changeset	62
0120d6214948 Code-Dokumentation angepasst. Florian Pose <fp@igh-essen.com> parents: 89 diff changeset	63	\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	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	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	67	{
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	68	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	69
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	70	// Read base data
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	71	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	72	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	73	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	74	slave->ring_position);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	75	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	76	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	77
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	78	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	79	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	80	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	81	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	82	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	83
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	84	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	85	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	86
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	87	// 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	88
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	89	if (unlikely(ec_slave_sii_read(slave, 0x0004,
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	90	(uint32_t *) &slave->sii_alias))) {
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	91	EC_ERR("Could not read SII alias!\n");
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	92	return -1;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	93	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	94
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	95	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	96	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	97	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	98	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	99
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	100	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	101	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	102	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	103	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	104
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	105	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	106	&slave->sii_revision_number))) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	107	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	108	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	109	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	110
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	111	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	112	&slave->sii_serial_number))) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	113	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	114	return -1;
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
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	117	return 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	118	}
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	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	121
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	122	/**
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	123	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	124	eines EtherCAT-Slaves.
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	125
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	126	\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	127	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	128
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	129	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	130	/*< EtherCAT-Slave /
101 b0c19892145a MERGE branches/async -r243:244 -> trunk (intypes). Florian Pose <fp@igh-essen.com> parents: 98 diff changeset	131	uint16_t offset,
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	132	/*< 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	133	uint32_t *target
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	134	/**< Zeiger auf einen 4 Byte großen Speicher zum Ablegen
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	135	der Daten */
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	{
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	138	ec_command_t command;
101 b0c19892145a MERGE branches/async -r243:244 -> trunk (intypes). Florian Pose <fp@igh-essen.com> parents: 98 diff changeset	139	uint8_t data[10];
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	140	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	141
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	142	// Initiate read operation
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	143
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	144	EC_WRITE_U8 (data, 0x00); // read-only access
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	145	EC_WRITE_U8 (data + 1, 0x01); // request read operation
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	146	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	147
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	148	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	149	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	150	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	151	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	152	}
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	// Der Slave legt die Informationen des Slave-Information-Interface
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	155	// in das Datenregister und löscht daraufhin ein Busy-Bit. Solange
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	156	// 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	157
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	158	start = get_cycles();
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	159	timeout = cpu_khz; // 1ms
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	160
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	161	while (1)
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	162	{
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	163	udelay(10);
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	164
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	165	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	166	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	167	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	168	slave->ring_position);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	169	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	170	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	171
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	172	end = get_cycles();
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	173
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	174	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	175	*target = EC_READ_U32(command.data + 6);
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	176	return 0;
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	177	}
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	178
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	179	if (unlikely((end - start) >= timeout)) {
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	180	EC_ERR("SSI-read. Slave %i timed out!\n", slave->ring_position);
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	181	return -1;
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	182	}
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	183	}
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	184	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	185
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
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	188	/**
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	189	Schreibt Daten in das Slave-Information-Interface
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	190	eines EtherCAT-Slaves.
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	191
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	192	\return 0 bei Erfolg, sonst < 0
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	193	*/
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	194
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	195	int ec_slave_sii_write(ec_slave_t *slave,
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	196	/*< EtherCAT-Slave /
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	197	uint16_t offset,
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	198	/*< Adresse des zu lesenden SII-Registers /
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	199	uint16_t value
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	200	/*< Zu schreibender Wert /
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	201	)
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	202	{
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	203	ec_command_t command;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	204	uint8_t data[8];
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	205	cycles_t start, end, timeout;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	206
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	207	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	208	slave->ring_position, offset, value);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	209
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	210	// Initiate write operation
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	211
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	212	EC_WRITE_U8 (data, 0x01); // enable write access
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	213	EC_WRITE_U8 (data + 1, 0x02); // request write operation
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	214	EC_WRITE_U32(data + 2, offset);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	215	EC_WRITE_U16(data + 6, value);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	216
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	217	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	218	if (unlikely(ec_master_simple_io(slave->master, &command))) {
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	219	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	220	return -1;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	221	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	222
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	223	// Der Slave legt die Informationen des Slave-Information-Interface
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	224	// in das Datenregister und löscht daraufhin ein Busy-Bit. Solange
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	225	// den Status auslesen, bis das Bit weg ist.
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	226
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	227	start = get_cycles();
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	228	timeout = cpu_khz; // 1ms
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	229
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	230	while (1)
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	231	{
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	232	udelay(10);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	233
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	234	ec_command_init_nprd(&command, slave->station_address, 0x502, 2);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	235	if (unlikely(ec_master_simple_io(slave->master, &command))) {
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	236	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	237	slave->ring_position);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	238	return -1;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	239	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	240
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	241	end = get_cycles();
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	242
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	243	if (likely((EC_READ_U8(command.data + 1) & 0x82) == 0)) {
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	244	if (EC_READ_U8(command.data + 1) & 0x40) {
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	245	EC_ERR("SII-write failed!\n");
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	246	return -1;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	247	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	248	else {
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	249	EC_INFO("SII-write succeeded!\n");
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	250	return 0;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	251	}
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
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	254	if (unlikely((end - start) >= timeout)) {
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	255	EC_ERR("SSI-write: Slave %i timed out!\n", slave->ring_position);
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	256	return -1;
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	257	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	258	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	259	}
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	260
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	261	/*****************************************************************************/
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	/**
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	264	Bestätigt einen Fehler beim Zustandswechsel.
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	265
91 0120d6214948 Code-Dokumentation angepasst. Florian Pose <fp@igh-essen.com> parents: 89 diff changeset	266	\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	267	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	268
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	269	void ec_slave_state_ack(ec_slave_t *slave,
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	270	/*< Slave, dessen Zustand geändert werden soll /
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	271	uint8_t state
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	272	/*< Alter Zustand /
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	273	)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	274	{
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	275	ec_command_t command;
101 b0c19892145a MERGE branches/async -r243:244 -> trunk (intypes). Florian Pose <fp@igh-essen.com> parents: 98 diff changeset	276	uint8_t data[2];
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	277	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	278
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	279	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	280
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	281	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	282	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	283	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	284	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	285	return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	286	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	287
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	288	start = get_cycles();
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	289	timeout = cpu_khz; // 1ms
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	290
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	291	while (1)
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	292	{
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	293	udelay(100); // Dem Slave etwas Zeit lassen...
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	294
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	295	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	296	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	297	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	298	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	299	return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	300	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	301
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	302	end = get_cycles();
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	303
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	304	if (unlikely(EC_READ_U8(command.data) != state)) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	305	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	306	" %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	307	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	308	return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	309	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	310
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	311	if (likely(EC_READ_U8(command.data) == state)) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	312	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	313	slave->ring_position);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	314	return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	315	}
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	316
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	317	if (unlikely((end - start) >= timeout)) {
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	318	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	319	" Timeout while checking!\n", state, slave->ring_position);
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	320	return;
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	321	}
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	322	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	323	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	324
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	325	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	326
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	327	/**
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	328	Ändert den Zustand eines Slaves.
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	329
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	330	\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	331	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	332
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	333	int ec_slave_state_change(ec_slave_t *slave,
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	334	/*< Slave, dessen Zustand geändert werden soll /
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	335	uint8_t state
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	336	/*< Neuer Zustand /
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	337	)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	338	{
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	339	ec_command_t command;
101 b0c19892145a MERGE branches/async -r243:244 -> trunk (intypes). Florian Pose <fp@igh-essen.com> parents: 98 diff changeset	340	uint8_t data[2];
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	341	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	342
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	343	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	344
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	345	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	346	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	347	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	348	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	349	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	350	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	351
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	352	start = get_cycles();
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	353	timeout = cpu_khz; // 1ms
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	354
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	355	while (1)
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	356	{
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	357	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	358
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	359	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	360	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	361	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	362	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	363	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	364	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	365
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	366	end = get_cycles();
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	367
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	368	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	369	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	370	" (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	371	EC_READ_U8(command.data));
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	372	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	373	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	374	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	375
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	376	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	377	// State change successful
113 a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	378	return 0;
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	379	}
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	380
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	381	if (unlikely((end - start) >= timeout)) {
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	382	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	383	state, slave->ring_position);
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	384	return -1;
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	385	}
a3dbd6bc8fce Do-Schleifen ersetzt. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	386	}
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	387	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	388
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	389	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	390
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	391	/**
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	392	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	393
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	394	Die FMMU wird so konfiguriert, dass sie den gesamten Datenbereich des
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	395	entsprechenden Sync-Managers abdeckt. Für jede Domäne werden separate
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	396	FMMUs konfiguriert.
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	397
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	398	Wenn die entsprechende FMMU bereits konfiguriert ist, wird dies als
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	399	Erfolg zurückgegeben.
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	400
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	401	\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	402	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	403
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	404	int ec_slave_set_fmmu(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	405	const ec_domain_t domain, /< Domäne /
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	406	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	407	)
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	408	{
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	409	unsigned int i;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	410
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	411	// FMMU schon vorgemerkt?
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	412	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	413	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	414	return 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	415
91 0120d6214948 Code-Dokumentation angepasst. Florian Pose <fp@igh-essen.com> parents: 89 diff changeset	416	// Neue FMMU reservieren...
0120d6214948 Code-Dokumentation angepasst. Florian Pose <fp@igh-essen.com> parents: 89 diff changeset	417
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	418	if (slave->fmmu_count >= slave->base_fmmu_count) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	419	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	420	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	421	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	422
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	423	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	424	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	425	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	426	slave->fmmu_count++;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	427	slave->registered = 1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	428
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	429	return 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	430	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	431
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	432	/*****************************************************************************/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	433
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	434	/**
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	435	Gibt alle Informationen über einen EtherCAT-Slave aus.
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	436	*/
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	437
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	438	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	439	{
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	440	EC_INFO("--- 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	441
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	442	if (slave->type) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	443	EC_INFO(" Vendor \"%s\", Product \"%s\": %s\n",
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	444	slave->type->vendor_name, slave->type->product_name,
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	445	slave->type->description);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	446	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	447	else {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	448	EC_INFO(" * This slave has no type information! *\n");
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	449	}
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	450
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	451	EC_INFO(" Ring position: %i, Station address: 0x%04X\n",
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	452	slave->ring_position, slave->station_address);
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	453
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	454	EC_INFO(" Base information:\n");
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	455	EC_INFO(" Type %u, Revision %i, Build %i\n",
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	456	slave->base_type, slave->base_revision, slave->base_build);
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	457	EC_INFO(" Supported FMMUs: %i, Sync managers: %i\n",
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	458	slave->base_fmmu_count, slave->base_sync_count);
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	459
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	460	EC_INFO(" Slave information interface:\n");
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	461	EC_INFO(" Configured station alias: 0x%04X (%i)\n", slave->sii_alias,
e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	462	slave->sii_alias);
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	463	EC_INFO(" Vendor-ID: 0x%08X, Product code: 0x%08X\n",
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	464	slave->sii_vendor_id, slave->sii_product_code);
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	465	EC_INFO(" Revision number: 0x%08X, Serial number: 0x%08X\n",
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	466	slave->sii_revision_number, slave->sii_serial_number);
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	467	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	468
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	469	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	470
74 9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	471	/**
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	472	Gibt die Zählerstände der CRC-Fault-Counter aus und setzt diese zurück.
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	473
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	474	\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	475	*/
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	476
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	477	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	478	{
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	479	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	480	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	481
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	482	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	483	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	484	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	485	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	486	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	487	}
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	488
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	489	// No CRC faults.
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	490	if (!EC_READ_U16(command.data) && !EC_READ_U16(command.data + 2)) return 0;
74 9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	491
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 77 diff changeset	492	EC_WARN("CRC faults on slave %i. A: %i, B: %i\n", slave->ring_position,
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	493	EC_READ_U16(command.data), EC_READ_U16(command.data + 2));
74 9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	494
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	495	// Reset CRC counters
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	496	EC_WRITE_U16(data, 0x0000);
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	497	EC_WRITE_U16(data + 2, 0x0000);
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: 91 diff changeset	498	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	499	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	500	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	501	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	502	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	503	}
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	504
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	505	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	506	}
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	507
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	508	/*****************************************************************************/
9bf603942791 Neues Slave-Interface, CRC-Pr?fung und mehrfaches Scannen nun ungef?hrlich. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	509
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	510	/* Emacs-Konfiguration
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	511	;;; Local Variables: ***
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 55 diff changeset	512	;;; c-basic-offset:4 ***
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	513	;;; End: ***
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	514	*/
114 e4b4b5a85e75 Slave alias implementiert. Florian Pose <fp@igh-essen.com> parents: 113 diff changeset	515

author	Florian Pose <fp@igh-essen.com>
	Mon, 20 Mar 2006 15:28:25 +0000
changeset 114	e4b4b5a85e75
parent 113	a3dbd6bc8fce
child 118	dc71ce4cc641
permissions	-rw-r--r--