etherlabmaster: drivers/ec_master.c@ad5f969f263b (annotated)

39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1	/******************************************************************************
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	2	*
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	3	* e c _ m a s t e r . c
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-Master.
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: 35 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: 35 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>
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	12	#include <linux/kernel.h>
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	13	#include <linux/string.h>
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	14	#include <linux/slab.h>
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	15	#include <linux/delay.h>
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	16
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	17	#include "ec_globals.h"
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	18	#include "ec_master.h"
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	19
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	20	/*****************************************************************************/
0 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	/**
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	23	Konstruktor des EtherCAT-Masters.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	24
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	25	@param master Zeiger auf den zu initialisierenden EtherCAT-Master
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	26	*/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	27
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	28	void EtherCAT_master_init(EtherCAT_master_t *master)
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	29	{
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	30	master->dev = NULL;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	31	master->command_index = 0x00;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	32	master->tx_data_length = 0;
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	33	master->rx_data_length = 0;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	34	master->domain_count = 0;
2 b0a7a4745bf9 ?nderungen an no_rtai r110:110 in drivers gemergt. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	35	master->debug_level = 0;
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	36	master->bus_time = 0;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	37	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	38
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	39	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	40
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	41	/**
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	42	Destruktor eines EtherCAT-Masters.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	43
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	44	Entfernt alle Kommandos aus der Liste, löscht den Zeiger
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	45	auf das Slave-Array und gibt die Prozessdaten frei.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	46
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	47	@param master Zeiger auf den zu löschenden Master
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	48	*/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	49
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	50	void EtherCAT_master_clear(EtherCAT_master_t *master)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	51	{
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	52	unsigned int i;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	53
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	54	// Remove domains
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	55	for (i = 0; i < master->domain_count; i++) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	56	EtherCAT_domain_clear(master->domains + i);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	57	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	58
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	59	master->domain_count = 0;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	60	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	61
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	62	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	63
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	64	/**
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	65	Öffnet ein EtherCAT-Geraet für den Master.
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	66
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	67	Registriert das Geraet beim Master, der es daraufhin oeffnet.
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	68
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	69	@param master Der EtherCAT-Master
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	70	@param device Das EtherCAT-Geraet
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	71	@return 0, wenn alles o.k.,
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	72	< 0, wenn bereits ein Geraet registriert
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	73	oder das Geraet nicht geoeffnet werden konnte.
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	74	*/
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	75
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	76	int EtherCAT_master_open(EtherCAT_master_t *master,
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	77	EtherCAT_device_t *device)
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	78	{
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	79	if (!master \|\| !device) {
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	80	printk(KERN_ERR "EtherCAT: Illegal parameters for master_open()!\n");
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	81	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	82	}
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	83
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	84	if (master->dev) {
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	85	printk(KERN_ERR "EtherCAT: Master already has a device.\n");
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	86	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	87	}
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	88
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	89	if (EtherCAT_device_open(device) < 0) {
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	90	printk(KERN_ERR "EtherCAT: Could not open device %X!\n",
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	91	(unsigned int) master->dev);
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	92	return -1;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	93	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	94
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	95	master->dev = device;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	96
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	97	return 0;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	98	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	99
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	100	/*****************************************************************************/
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	101
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	102	/**
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	103	Schliesst das EtherCAT-Geraet, auf dem der Master arbeitet.
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	104
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	105	@param master Der EtherCAT-Master
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	106	@param device Das EtherCAT-Geraet
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	107	*/
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	108
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	109	void EtherCAT_master_close(EtherCAT_master_t *master,
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	110	EtherCAT_device_t *device)
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	111	{
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	112	if (master->dev != device) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	113	printk(KERN_WARNING "EtherCAT: Warning -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	114	" Trying to close an unknown device!\n");
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	115	return;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	116	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	117
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	118	if (EtherCAT_device_close(master->dev) < 0) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	119	printk(KERN_WARNING "EtherCAT: Warning -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	120	" Could not close device!\n");
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	121	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	122
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	123	master->dev = NULL;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	124	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	125
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	126	/*****************************************************************************/
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	127
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	128	/**
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	129	Sendet ein einzelnes Kommando in einem Frame und
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	130	wartet auf dessen Empfang.
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	131
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	132	@param master EtherCAT-Master
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	133	@param cmd Kommando zum Senden/Empfangen
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	134
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	135	@return 0 bei Erfolg, sonst < 0
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	136	*/
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	137
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	138	int EtherCAT_simple_send_receive(EtherCAT_master_t *master,
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	139	EtherCAT_command_t *cmd)
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	140	{
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	141	unsigned int tries_left;
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	142
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	143	if (unlikely(EtherCAT_simple_send(master, cmd) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	144	return -1;
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	145
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	146	udelay(3);
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	147
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	148	EtherCAT_device_call_isr(master->dev);
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	149
29 8c16582f2394 tries left auf 20 geaendert Wilhelm Hagemeister <hm@igh-essen.com> parents: 27 diff changeset	150	tries_left = 20;
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	151	while (unlikely(master->dev->state == ECAT_DS_SENT
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	152	&& tries_left)) {
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	153	udelay(1);
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	154	EtherCAT_device_call_isr(master->dev);
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	155	tries_left--;
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	156	}
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	157
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	158	if (unlikely(EtherCAT_simple_receive(master, cmd) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	159	return -1;
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	160
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	161	return 0;
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	162	}
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	163
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	164	/*****************************************************************************/
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	165
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	166	/**
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	167	Sendet ein einzelnes Kommando in einem Frame.
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	168
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	169	@param master EtherCAT-Master
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	170	@param cmd Kommando zum Senden
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	171
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	172	@return 0 bei Erfolg, sonst < 0
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	173	*/
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	174
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	175	int EtherCAT_simple_send(EtherCAT_master_t *master,
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	176	EtherCAT_command_t *cmd)
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	177	{
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	178	unsigned int length, framelength, i;
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	179
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	180	if (unlikely(master->debug_level > 0)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	181	printk(KERN_DEBUG "EtherCAT_send_receive_command\n");
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	182	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	183
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	184	if (unlikely(cmd->state != ECAT_CS_READY)) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	185	printk(KERN_WARNING "EtherCAT_send_receive_command:"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	186	"Command not in ready state!\n");
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	187	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	188
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	189	length = cmd->data_length + 12;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	190	framelength = length + 2;
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	191
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	192	if (unlikely(framelength > ECAT_FRAME_BUFFER_SIZE)) {
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	193	printk(KERN_ERR "EtherCAT: Frame too long (%i)!\n", framelength);
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	194	return -1;
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	195	}
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	196
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	197	if (framelength < 46) framelength = 46;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	198
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	199	if (unlikely(master->debug_level > 0)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	200	printk(KERN_DEBUG "Frame length: %i\n", framelength);
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	201	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	202
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	203	master->tx_data[0] = length & 0xFF;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	204	master->tx_data[1] = ((length & 0x700) >> 8) \| 0x10;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	205
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	206	cmd->index = master->command_index;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	207	master->command_index = (master->command_index + 1) % 0x0100;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	208
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	209	if (unlikely(master->debug_level > 0)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	210	printk(KERN_DEBUG "Sending command index %i\n", cmd->index);
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	211	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	212
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	213	cmd->state = ECAT_CS_SENT;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	214
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	215	master->tx_data[2 + 0] = cmd->type;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	216	master->tx_data[2 + 1] = cmd->index;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	217	master->tx_data[2 + 2] = cmd->address.raw[0];
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	218	master->tx_data[2 + 3] = cmd->address.raw[1];
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	219	master->tx_data[2 + 4] = cmd->address.raw[2];
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	220	master->tx_data[2 + 5] = cmd->address.raw[3];
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	221	master->tx_data[2 + 6] = cmd->data_length & 0xFF;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	222	master->tx_data[2 + 7] = (cmd->data_length & 0x700) >> 8;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	223	master->tx_data[2 + 8] = 0x00;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	224	master->tx_data[2 + 9] = 0x00;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	225
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	226	if (likely(cmd->type == ECAT_CMD_APWR
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	227	\|\| cmd->type == ECAT_CMD_NPWR
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	228	\|\| cmd->type == ECAT_CMD_BWR
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	229	\|\| cmd->type == ECAT_CMD_LRW)) // Write commands
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	230	{
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	231	for (i = 0; i < cmd->data_length; i++)
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	232	master->tx_data[2 + 10 + i] = cmd->data[i];
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	233	}
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	234	else // Read commands
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	235	{
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	236	for (i = 0; i < cmd->data_length; i++) master->tx_data[2 + 10 + i] = 0x00;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	237	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	238
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	239	master->tx_data[2 + 10 + cmd->data_length] = 0x00;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	240	master->tx_data[2 + 11 + cmd->data_length] = 0x00;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	241
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	242	// Pad with zeros
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	243	for (i = cmd->data_length + 12 + 2; i < 46; i++) master->tx_data[i] = 0x00;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	244
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	245	master->tx_data_length = framelength;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	246
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	247	if (unlikely(master->debug_level > 0)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	248	printk(KERN_DEBUG "device send...\n");
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	249	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	250
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	251	// Send frame
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	252	if (unlikely(EtherCAT_device_send(master->dev,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	253	master->tx_data,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	254	framelength) != 0)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	255	printk(KERN_ERR "EtherCAT: Could not send!\n");
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	256	return -1;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	257	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	258
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	259	if (unlikely(master->debug_level > 0)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	260	printk(KERN_DEBUG "EtherCAT_send done.\n");
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	261	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	262
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	263	return 0;
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	264	}
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	265
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	266	/*****************************************************************************/
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	267
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	268	/**
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	269	Wartet auf den Empfang eines einzeln gesendeten
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	270	Kommandos.
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	271
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	272	@param master EtherCAT-Master
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	273	@param cmd Gesendetes Kommando
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	274
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	275	@return 0 bei Erfolg, sonst < 0
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	276	*/
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	277
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	278	int EtherCAT_simple_receive(EtherCAT_master_t *master,
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	279	EtherCAT_command_t *cmd)
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	280	{
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	281	unsigned int length;
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	282	int ret;
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	283	unsigned char command_type, command_index;
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	284
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	285	if (unlikely((ret = EtherCAT_device_receive(master->dev,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	286	master->rx_data)) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	287	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	288
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	289	master->rx_data_length = (unsigned int) ret;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	290
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	291	if (unlikely(master->rx_data_length < 2)) {
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	292	printk(KERN_ERR "EtherCAT: Received frame with incomplete"
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	293	" EtherCAT header!\n");
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	294	output_debug_data(master);
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	295	return -1;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	296	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	297
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	298	// Länge des gesamten Frames prüfen
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	299	length = ((master->rx_data[1] & 0x07) << 8)
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	300	\| (master->rx_data[0] & 0xFF);
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	301
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	302	if (unlikely(length > master->rx_data_length)) {
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	303	printk(KERN_ERR "EtherCAT: Received corrupted frame (length does"
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	304	" not match)!\n");
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	305	output_debug_data(master);
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	306	return -1;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	307	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	308
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	309	command_type = master->rx_data[2];
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	310	command_index = master->rx_data[2 + 1];
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	311	length = (master->rx_data[2 + 6] & 0xFF)
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	312	\| ((master->rx_data[2 + 7] & 0x07) << 8);
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	313
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	314	if (unlikely(master->rx_data_length - 2 < length + 12)) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	315	printk(KERN_ERR "EtherCAT: Received frame with"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	316	" incomplete command data!\n");
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	317	output_debug_data(master);
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	318	return -1;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	319	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	320
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	321	if (likely(cmd->state == ECAT_CS_SENT
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	322	&& cmd->type == command_type
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	323	&& cmd->index == command_index
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	324	&& cmd->data_length == length))
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	325	{
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	326	cmd->state = ECAT_CS_RECEIVED;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	327
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	328	// Empfangene Daten in Kommandodatenspeicher kopieren
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	329	memcpy(cmd->data, master->rx_data + 2 + 10, length);
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	330
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	331	// Working-Counter setzen
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	332	cmd->working_counter
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	333	= ((master->rx_data[length + 2 + 10] & 0xFF)
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	334	\| ((master->rx_data[length + 2 + 11] & 0xFF) << 8));
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	335	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	336	else
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	337	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	338	printk(KERN_WARNING "EtherCAT: WARNING - Send/Receive anomaly!\n");
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	339	output_debug_data(master);
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	340	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	341
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	342	master->dev->state = ECAT_DS_READY;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	343
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	344	return 0;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	345	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	346
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	347	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	348
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	349	/**
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	350	Überprüft die angeschlossenen Slaves.
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	351
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	352	Vergleicht die an den Bus angeschlossenen Slaves mit
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	353	den im statischen-Slave-Array vorgegebenen Konfigurationen.
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	354	Stimmen Anzahl oder Typen nicht überein, gibt diese
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	355	Methode einen Fehler aus.
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	356
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	357	@param master Der EtherCAT-Master
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	358	@param slaves Zeiger auf ein statisches Slave-Array
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	359	@param slave_count Anzahl der Slaves im Array
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	360
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	361	@return 0 bei Erfolg, sonst < 0
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	362	*/
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	363
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	364	int EtherCAT_check_slaves(EtherCAT_master_t *master,
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	365	EtherCAT_slave_t *slaves,
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	366	unsigned int slave_count)
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	367	{
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	368	EtherCAT_command_t cmd;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	369	EtherCAT_slave_t *cur;
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	370	unsigned int i, j, found, size, offset;
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	371	unsigned char data[2];
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	372	EtherCAT_domain_t *dom;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	373
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	374	// Clear domains
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	375	for (i = 0; i < master->domain_count; i++) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	376	printk(KERN_DEBUG "EtherCAT: Clearing domain %i!\n",
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	377	master->domains[i].number);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	378	EtherCAT_domain_clear(master->domains + i);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	379	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	380	master->domain_count = 0;
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	381
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	382	if (unlikely(!slave_count)) {
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	383	printk(KERN_ERR "EtherCAT: No slaves in list!\n");
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	384	return -1;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	385	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	386
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	387	// Determine number of slaves on bus
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	388
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	389	EtherCAT_command_broadcast_read(&cmd, 0x0000, 4);
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	390
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	391	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	392	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	393
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	394	if (unlikely(cmd.working_counter != slave_count)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	395	printk(KERN_ERR "EtherCAT: Wrong number of slaves on bus: %i / %i\n",
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	396	cmd.working_counter, slave_count);
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	397	return -1;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	398	}
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	399
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	400	printk("EtherCAT: Found all %i slaves.\n", slave_count);
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	401
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	402	// For every slave in the list
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	403	for (i = 0; i < slave_count; i++)
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	404	{
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	405	cur = &slaves[i];
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	406
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	407	if (unlikely(!cur->desc)) {
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	408	printk(KERN_ERR "EtherCAT: Slave %i has no description.\n", i);
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	409	return -1;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	410	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	411
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	412	// Set ring position
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	413	cur->ring_position = -i;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	414	cur->station_address = i + 1;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	415
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	416	// Write station address
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	417
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	418	data[0] = cur->station_address & 0x00FF;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	419	data[1] = (cur->station_address & 0xFF00) >> 8;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	420
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	421	EtherCAT_command_position_write(&cmd, cur->ring_position,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	422	0x0010, 2, data);
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	423
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	424	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	425	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	426
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	427	if (unlikely(cmd.working_counter != 1)) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	428	printk(KERN_ERR "EtherCAT: Slave %i did not repond"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	429	" while writing station address!\n", i);
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	430	return -1;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	431	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	432
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	433	// Read base data
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	434
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	435	EtherCAT_command_read(&cmd, cur->station_address, 0x0000, 4);
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	436
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	437	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	438	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	439
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	440	if (unlikely(cmd.working_counter != 1)) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	441	printk(KERN_ERR "EtherCAT: Slave %i did not respond"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	442	" while reading base data!\n", i);
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	443	return -1;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	444	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	445
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	446	// Get base data
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	447
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	448	cur->type = cmd.data[0];
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	449	cur->revision = cmd.data[1];
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	450	cur->build = cmd.data[2] \| (cmd.data[3] << 8);
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	451
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	452	// Read identification from "Slave Information Interface" (SII)
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	453
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	454	if (unlikely(EtherCAT_read_slave_information(master,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	455	cur->station_address,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	456	0x0008,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	457	&cur->vendor_id) != 0))
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	458	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	459	printk(KERN_ERR "EtherCAT: Could not read SII vendor id!\n");
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	460	return -1;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	461	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	462
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	463	if (unlikely(EtherCAT_read_slave_information(master,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	464	cur->station_address,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	465	0x000A,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	466	&cur->product_code) != 0))
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	467	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	468	printk(KERN_ERR "EtherCAT: Could not read SII product code!\n");
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	469	return -1;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	470	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	471
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	472	if (unlikely(EtherCAT_read_slave_information(master,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	473	cur->station_address,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	474	0x000C,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	475	&cur->revision_number) != 0))
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	476	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	477	printk(KERN_ERR "EtherCAT: Could not read SII revision number!\n");
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	478	return -1;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	479	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	480
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	481	if (unlikely(EtherCAT_read_slave_information(master,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	482	cur->station_address,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	483	0x000E,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	484	&cur->serial_number) != 0))
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	485	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	486	printk(KERN_ERR "EtherCAT: Could not read SII serial number!\n");
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	487	return -1;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	488	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	489
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	490	// Search for identification in "database"
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	491
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	492	found = 0;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	493
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	494	for (j = 0; j < slave_ident_count; j++)
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	495	{
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	496	if (unlikely(slave_idents[j].vendor_id == cur->vendor_id
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	497	&& slave_idents[j].product_code == cur->product_code))
2 b0a7a4745bf9 ?nderungen an no_rtai r110:110 in drivers gemergt. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	498	{
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	499	found = 1;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	500
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	501	if (unlikely(cur->desc != slave_idents[j].desc)) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	502	printk(KERN_ERR "EtherCAT: Unexpected slave device"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	503	" \"%s %s\" at position %i. Expected: \"%s %s\"\n",
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	504	slave_idents[j].desc->vendor_name,
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	505	slave_idents[j].desc->product_name, i,
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	506	cur->desc->vendor_name, cur->desc->product_name);
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	507	return -1;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	508	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	509
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	510	break;
2 b0a7a4745bf9 ?nderungen an no_rtai r110:110 in drivers gemergt. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	511	}
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	512	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	513
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	514	if (unlikely(!found)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	515	printk(KERN_ERR "EtherCAT: Unknown slave device"
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	516	" (vendor %X, code %X) at position %i.\n",
35 ed834aa98f89 Klemme Beckhoff EL4132 hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	517	cur->vendor_id, cur->product_code, i);
2 b0a7a4745bf9 ?nderungen an no_rtai r110:110 in drivers gemergt. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	518	return -1;
b0a7a4745bf9 ?nderungen an no_rtai r110:110 in drivers gemergt. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	519	}
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	520
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	521	// Check, if process data domain already exists...
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	522	found = 0;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	523	for (j = 0; j < master->domain_count; j++) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	524	if (cur->domain == master->domains[j].number) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	525	found = 1;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	526	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	527	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	528
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	529	// Create process data domain
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	530	if (!found) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	531	if (master->domain_count + 1 >= ECAT_MAX_DOMAINS) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	532	printk(KERN_ERR "EtherCAT: Too many domains!\n");
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	533	return -1;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	534	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	535
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	536	EtherCAT_domain_init(&master->domains[master->domain_count]);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	537	master->domains[master->domain_count].number = cur->domain;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	538	master->domain_count++;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	539	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	540	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	541
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	542	// Calculate domain sizes
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	543	offset = 0;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	544	for (i = 0; i < master->domain_count; i++)
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	545	{
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	546	dom = master->domains + i;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	547
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	548	dom->logical_offset = offset;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	549
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	550	// For every slave in the list
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	551	size = 0;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	552	for (j = 0; j < slave_count; j++) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	553	if (slaves[j].domain == dom->number) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	554	size += slaves[j].desc->process_data_size;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	555	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	556	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	557
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	558	if (size > ECAT_FRAME_BUFFER_SIZE - 14) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	559	printk(KERN_ERR "EtherCAT: Oversized domain %i: %i / %i Bytes!\n",
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	560	dom->number, size, ECAT_FRAME_BUFFER_SIZE - 14);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	561	return -1;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	562	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	563
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	564	if (!(dom->data = (unsigned char *) kmalloc(sizeof(unsigned char)
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	565	* size, GFP_KERNEL))) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	566	printk(KERN_ERR "EtherCAT: Could not allocate"
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	567	" %i bytes of domain data.\n", size);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	568	return -1;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	569	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	570
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	571	dom->data_size = size;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	572	memset(dom->data, 0x00, size);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	573
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	574	printk(KERN_INFO "EtherCAT: Domain %i: %i Bytes of process data.\n",
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	575	dom->number, size);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	576
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	577	// Set logical addresses and data pointers of domain slaves
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	578	size = 0;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	579	for (j = 0; j < slave_count; j++) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	580	if (slaves[j].domain == dom->number) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	581	slaves[j].process_data = dom->data + size;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	582	slaves[j].logical_address = dom->logical_offset + size;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	583	size += slaves[j].desc->process_data_size;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	584	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	585	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	586
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	587	offset += size;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	588	}
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	589
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	590	return 0;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	591	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	592
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	593	/*****************************************************************************/
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	594
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	595	/**
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	596	Liest Daten aus dem Slave-Information-Interface
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	597	eines EtherCAT-Slaves.
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	598
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	599	@param master EtherCAT-Master
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	600	@param node_address Knotenadresse des Slaves
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	601	@param offset Adresse des zu lesenden SII-Registers
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	602	@param target Zeiger auf einen 4 Byte großen Speicher
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	603	zum Ablegen der Daten
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	604
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	605	@return 0 bei Erfolg, sonst < 0
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	606	*/
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	607
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	608	int EtherCAT_read_slave_information(EtherCAT_master_t *master,
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	609	unsigned short int node_address,
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	610	unsigned short int offset,
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	611	unsigned int *target)
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	612	{
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	613	EtherCAT_command_t cmd;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	614	unsigned char data[10];
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	615	unsigned int tries_left;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	616
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	617	// Initiate read operation
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	618
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	619	data[0] = 0x00;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	620	data[1] = 0x01;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	621	data[2] = offset & 0xFF;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	622	data[3] = (offset & 0xFF00) >> 8;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	623	data[4] = 0x00;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	624	data[5] = 0x00;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	625
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	626	EtherCAT_command_write(&cmd, node_address, 0x502, 6, data);
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	627
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	628	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) < 0))
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	629	return -1;
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	630
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	631	if (unlikely(cmd.working_counter != 1)) {
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	632	printk(KERN_ERR "EtherCAT: SII-read - Slave %04X did not respond!\n",
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	633	node_address);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	634	return -1;
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	635	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	636
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	637	// Der Slave legt die Informationen des Slave-Information-Interface
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	638	// in das Datenregister und löscht daraufhin ein Busy-Bit. Solange
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	639	// den Status auslesen, bis das Bit weg ist.
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	640
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	641	tries_left = 100;
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	642	while (likely(tries_left))
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	643	{
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	644	udelay(10);
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	645
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	646	EtherCAT_command_read(&cmd, node_address, 0x502, 10);
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	647
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	648	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) != 0))
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	649	return -1;
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	650
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	651	if (unlikely(cmd.working_counter != 1)) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	652	printk(KERN_ERR "EtherCAT: SII-read status -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	653	" Slave %04X did not respond!\n", node_address);
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	654	return -1;
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	655	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	656
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	657	if (likely((cmd.data[1] & 0x81) == 0)) {
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	658	memcpy(target, cmd.data + 6, 4);
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	659	break;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	660	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	661
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	662	tries_left--;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	663	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	664
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	665	if (unlikely(!tries_left)) {
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	666	printk(KERN_WARNING "EtherCAT: SSI-read. Slave %04X timed out!\n",
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	667	node_address);
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	668	return -1;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	669	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	670
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	671	return 0;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	672	}
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	673
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	674	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	675
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	676	/**
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	677	Ändert den Zustand eines Slaves (asynchron).
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	678
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	679	Führt eine (asynchrone) Zustandsänderung bei einem Slave durch.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	680
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	681	@param master EtherCAT-Master
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	682	@param slave Slave, dessen Zustand geändert werden soll
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	683	@param state_and_ack Neuer Zustand, evtl. mit gesetztem
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	684	Acknowledge-Flag
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	685
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	686	@return 0 bei Erfolg, sonst < 0
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	687	*/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	688
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	689	int EtherCAT_state_change(EtherCAT_master_t *master,
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	690	EtherCAT_slave_t *slave,
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	691	unsigned char state_and_ack)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	692	{
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	693	EtherCAT_command_t cmd;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	694	unsigned char data[2];
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	695	unsigned int tries_left;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	696
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	697	data[0] = state_and_ack;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	698	data[1] = 0x00;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	699
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	700	EtherCAT_command_write(&cmd, slave->station_address,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	701	0x0120, 2, data);
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	702
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	703	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) != 0)) {
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	704	printk(KERN_ERR "EtherCAT: Could not set state %02X - Unable to send!\n",
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	705	state_and_ack);
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	706	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	707	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	708
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	709	if (unlikely(cmd.working_counter != 1)) {
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	710	printk(KERN_ERR "EtherCAT: Could not set state %02X - Device \"%s %s\""
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	711	" (%d) did not respond!\n", state_and_ack, slave->desc->vendor_name,
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	712	slave->desc->product_name, slave->ring_position * (-1));
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	713	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	714	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	715
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	716	slave->requested_state = state_and_ack & 0x0F;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	717
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	718	tries_left = 100;
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	719	while (likely(tries_left))
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	720	{
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	721	udelay(10);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	722
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	723	EtherCAT_command_read(&cmd, slave->station_address, 0x0130, 2);
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	724
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	725	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) != 0)) {
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	726	printk(KERN_ERR "EtherCAT: Could not check state %02X - Unable to"
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	727	" send!\n", state_and_ack);
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	728	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	729	}
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	730
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	731	if (unlikely(cmd.working_counter != 1)) {
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	732	printk(KERN_ERR "EtherCAT: Could not check state %02X - Device did not"
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	733	" respond!\n", state_and_ack);
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	734	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	735	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	736
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	737	if (unlikely(cmd.data[0] & 0x10)) { // State change error
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	738	printk(KERN_ERR "EtherCAT: Could not set state %02X - Device refused"
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	739	" state change (code %02X)!\n", state_and_ack, cmd.data[0]);
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	740	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	741	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	742
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	743	if (likely(cmd.data[0] == (state_and_ack & 0x0F))) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	744	// State change successful
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	745	break;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	746	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	747
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	748	tries_left--;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	749	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	750
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	751	if (unlikely(!tries_left)) {
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	752	printk(KERN_ERR "EtherCAT: Could not check state %02X - Timeout while"
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	753	" checking!\n", state_and_ack);
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	754	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	755	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	756
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	757	slave->current_state = state_and_ack & 0x0F;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	758
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	759	return 0;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	760	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	761
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	762	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	763
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	764	/**
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	765	Konfiguriert einen Slave und setzt den Operational-Zustand.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	766
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	767	Führt eine komplette Konfiguration eines Slaves durch,
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	768	setzt Sync-Manager und FMMU's, führt die entsprechenden
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	769	Zustandsübergänge durch, bis der Slave betriebsbereit ist.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	770
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	771	@param master EtherCAT-Master
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	772	@param slave Zu aktivierender Slave
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	773
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	774	@return 0 bei Erfolg, sonst < 0
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	775	*/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	776
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	777	int EtherCAT_activate_slave(EtherCAT_master_t *master,
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	778	EtherCAT_slave_t *slave)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	779	{
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	780	EtherCAT_command_t cmd;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	781	const EtherCAT_slave_desc_t *desc;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	782	unsigned char fmmu[16];
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	783	unsigned char data[256];
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	784
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	785	desc = slave->desc;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	786
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	787	if (unlikely(EtherCAT_state_change(master, slave, ECAT_STATE_INIT) != 0))
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	788	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	789
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	790	// Resetting FMMU's
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	791
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	792	memset(data, 0x00, 256);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	793
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	794	EtherCAT_command_write(&cmd, slave->station_address, 0x0600, 256, data);
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	795
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	796	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	797	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	798
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	799	if (unlikely(cmd.working_counter != 1)) {
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	800	printk(KERN_ERR "EtherCAT: Resetting FMMUs - Slave %04X did not"
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	801	" respond!\n", slave->station_address);
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	802	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	803	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	804
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	805	// Resetting Sync Manager channels
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	806
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	807	if (desc->type != ECAT_ST_SIMPLE_NOSYNC)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	808	{
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	809	memset(data, 0x00, 256);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	810
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	811	EtherCAT_command_write(&cmd, slave->station_address, 0x0800, 256, data);
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	812
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	813	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	814	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	815
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	816	if (unlikely(cmd.working_counter != 1)) {
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	817	printk(KERN_ERR "EtherCAT: Resetting SMs - Slave %04X did not"
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	818	" respond!\n", slave->station_address);
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	819	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	820	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	821	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	822
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	823	// Init Mailbox communication
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	824
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	825	if (desc->type == ECAT_ST_MAILBOX)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	826	{
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	827	if (desc->sm0)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	828	{
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	829	EtherCAT_command_write(&cmd, slave->station_address, 0x0800, 8,
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	830	desc->sm0);
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	831
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	832	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	833	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	834
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	835	if (unlikely(cmd.working_counter != 1)) {
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	836	printk(KERN_ERR "EtherCAT: Setting SM0 - Slave %04X did not"
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	837	" respond!\n", slave->station_address);
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	838	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	839	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	840	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	841
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	842	if (desc->sm1)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	843	{
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	844	EtherCAT_command_write(&cmd, slave->station_address, 0x0808, 8,
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	845	desc->sm1);
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	846
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	847	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	848	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	849
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	850	if (unlikely(cmd.working_counter != 1)) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	851	printk(KERN_ERR "EtherCAT: Setting SM1 -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	852	" Slave %04X did not respond!\n",
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	853	slave->station_address);
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	854	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	855	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	856	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	857	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	858
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	859	// Change state to PREOP
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	860
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	861	if (unlikely(EtherCAT_state_change(master, slave, ECAT_STATE_PREOP) != 0))
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	862	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	863
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	864	// Set FMMU's
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	865
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	866	if (desc->fmmu0)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	867	{
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	868	if (unlikely(!slave->process_data)) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	869	printk(KERN_ERR "EtherCAT: Warning - Slave %04X is not assigned to any"
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	870	" process data object!\n", slave->station_address);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	871	return -1;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	872	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	873
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	874	memcpy(fmmu, desc->fmmu0, 16);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	875
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	876	fmmu[0] = slave->logical_address & 0x000000FF;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	877	fmmu[1] = (slave->logical_address & 0x0000FF00) >> 8;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	878	fmmu[2] = (slave->logical_address & 0x00FF0000) >> 16;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	879	fmmu[3] = (slave->logical_address & 0xFF000000) >> 24;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	880
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	881	EtherCAT_command_write(&cmd, slave->station_address, 0x0600, 16, fmmu);
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	882
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	883	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	884	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	885
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	886	if (unlikely(cmd.working_counter != 1)) {
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	887	printk(KERN_ERR "EtherCAT: Setting FMMU0 - Slave %04X did not"
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	888	" respond!\n", slave->station_address);
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	889	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	890	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	891	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	892
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	893	// Set Sync Managers
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	894
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	895	if (desc->type != ECAT_ST_MAILBOX)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	896	{
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	897	if (desc->sm0)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	898	{
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	899	EtherCAT_command_write(&cmd, slave->station_address, 0x0800, 8,
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	900	desc->sm0);
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	901
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	902	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	903	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	904
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	905	if (unlikely(cmd.working_counter != 1)) {
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	906	printk(KERN_ERR "EtherCAT: Setting SM0 - Slave %04X did not"
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	907	" respond!\n", slave->station_address);
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	908	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	909	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	910	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	911
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	912	if (desc->sm1)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	913	{
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	914	EtherCAT_command_write(&cmd, slave->station_address, 0x0808, 8,
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	915	desc->sm1);
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	916
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	917	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	918	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	919
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	920	if (unlikely(cmd.working_counter != 1)) {
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	921	printk(KERN_ERR "EtherCAT: Setting SM1 - Slave %04X did not"
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	922	" respond!\n", slave->station_address);
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	923	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	924	}
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	925	}
f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	926	}
f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	927
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	928	if (desc->sm2)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	929	{
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	930	EtherCAT_command_write(&cmd, slave->station_address, 0x0810, 8, desc->sm2);
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	931
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	932	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	933	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	934
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	935	if (unlikely(cmd.working_counter != 1)) {
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	936	printk(KERN_ERR "EtherCAT: Setting SM2 - Slave %04X did not respond!\n",
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	937	slave->station_address);
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	938	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	939	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	940	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	941
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	942	if (desc->sm3)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	943	{
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	944	EtherCAT_command_write(&cmd, slave->station_address, 0x0818, 8, desc->sm3);
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	945
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	946	if (unlikely(EtherCAT_simple_send_receive(master, &cmd) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	947	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	948
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	949	if (unlikely(cmd.working_counter != 1)) {
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	950	printk(KERN_ERR "EtherCAT: Setting SM3 - Slave %04X did not respond!\n",
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	951	slave->station_address);
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	952	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	953	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	954	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	955
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	956	// Change state to SAVEOP
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	957	if (unlikely(EtherCAT_state_change(master, slave, ECAT_STATE_SAVEOP) != 0))
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	958	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	959
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	960	// Change state to OP
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	961	if (unlikely(EtherCAT_state_change(master, slave, ECAT_STATE_OP) != 0))
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	962	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	963
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	964	return 0;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	965	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	966
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	967	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	968
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	969	/**
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	970	Setzt einen Slave zurück in den Init-Zustand.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	971
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	972	@param master EtherCAT-Master
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	973	@param slave Zu deaktivierender Slave
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	974
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	975	@return 0 bei Erfolg, sonst < 0
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	976	*/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	977
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	978	int EtherCAT_deactivate_slave(EtherCAT_master_t *master,
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	979	EtherCAT_slave_t *slave)
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	980	{
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	981	if (unlikely(EtherCAT_state_change(master, slave,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	982	ECAT_STATE_INIT) != 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	983	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	984
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	985	return 0;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	986	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	987
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	988	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	989
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	990	/**
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	991	Sendet und empfängt Prozessdaten der angegebenen Domäne
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	992
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	993	@param master EtherCAT-Master
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	994	domain Domäne
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	995	timeout_us Timeout in Mikrosekunden
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	996
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	997	@return 0 bei Erfolg, sonst < 0
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	998	*/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	999
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1000	int EtherCAT_process_data_cycle(EtherCAT_master_t *master, unsigned int domain,
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1001	unsigned int timeout_us)
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1002	{
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1003	unsigned int i;
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1004	EtherCAT_domain_t *dom;
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1005	unsigned long start_ticks, end_ticks, timeout_ticks;
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1006
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1007	dom = NULL;
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1008	for (i = 0; i < master->domain_count; i++) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1009	if (master->domains[i].number == domain) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1010	dom = master->domains + i;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1011	break;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1012	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1013	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1014
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1015	if (unlikely(!dom)) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1016	printk(KERN_ERR "EtherCAT: No such domain: %i!\n", domain);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1017	return -1;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1018	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1019
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1020	EtherCAT_command_logical_read_write(&dom->command,
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1021	dom->logical_offset, dom->data_size,
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1022	dom->data);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1023
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1024	rdtscl(start_ticks); // Sendezeit nehmen
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1025
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1026	if (unlikely(EtherCAT_simple_send(master, &dom->command) < 0)) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1027	printk(KERN_ERR "EtherCAT: Could not send process data command!\n");
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1028	return -1;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1029	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1030
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1031	timeout_ticks = timeout_us * cpu_khz / 1000;
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1032
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1033	// Warten
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1034	do {
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1035	EtherCAT_device_call_isr(master->dev);
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1036	rdtscl(end_ticks); // Empfangszeit nehmen
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1037	}
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1038	while (unlikely(master->dev->state == ECAT_DS_SENT
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1039	&& end_ticks - start_ticks < timeout_ticks));
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1040
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1041	master->bus_time = (end_ticks - start_ticks) * 1000 / cpu_khz;
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1042
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	1043	if (unlikely(end_ticks - start_ticks >= timeout_ticks)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1044	printk(KERN_ERR "EtherCAT: Timeout while receiving process data!\n");
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1045	return -1;
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1046	}
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1047
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1048	if (unlikely(EtherCAT_simple_receive(master, &dom->command) < 0)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1049	printk(KERN_ERR "EtherCAT: Could not receive cyclic command!\n");
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1050	return -1;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1051	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1052
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1053	if (unlikely(dom->command.state != ECAT_CS_RECEIVED)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1054	printk(KERN_WARNING "EtherCAT: Process data command not received!\n");
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1055	return -1;
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1056	}
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1057
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1058	// Daten vom Kommando in den Prozessdatenspeicher kopieren
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1059	memcpy(dom->data, dom->command.data, dom->data_size);
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1060
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1061	return 0;
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1062	}
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1063
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1064	/*****************************************************************************/
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1065
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1066	/**
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	1067	Gibt Frame-Inhalte zwecks Debugging aus.
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	1068
20 7dd6216fb7cf Dokumentation angeglichen. Florian Pose <fp@igh-essen.com> parents: 19 diff changeset	1069	@param master EtherCAT-Master
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	1070	*/
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	1071
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1072	void output_debug_data(const EtherCAT_master_t *master)
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	1073	{
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	1074	unsigned int i;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	1075
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1076	printk(KERN_DEBUG "EtherCAT: tx_data content (%i Bytes):\n",
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1077	master->tx_data_length);
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1078
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1079	printk(KERN_DEBUG);
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1080	for (i = 0; i < master->tx_data_length; i++)
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1081	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1082	printk("%02X ", master->tx_data[i]);
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1083	if ((i + 1) % 16 == 0) printk("\n" KERN_DEBUG);
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1084	}
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1085	printk("\n");
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1086
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1087	printk(KERN_DEBUG "EtherCAT: rx_data content (%i Bytes):\n",
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1088	master->rx_data_length);
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1089
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1090	printk(KERN_DEBUG);
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1091	for (i = 0; i < master->rx_data_length; i++)
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1092	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1093	printk("%02X ", master->rx_data[i]);
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1094	if ((i + 1) % 16 == 0) printk("\n" KERN_DEBUG);
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1095	}
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1096	printk("\n");
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1097	}
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1098
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1099	/*****************************************************************************/
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	1100
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	1101	EXPORT_SYMBOL(EtherCAT_master_init);
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	1102	EXPORT_SYMBOL(EtherCAT_master_clear);
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	1103	EXPORT_SYMBOL(EtherCAT_master_open);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	1104	EXPORT_SYMBOL(EtherCAT_master_close);
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	1105	EXPORT_SYMBOL(EtherCAT_check_slaves);
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1106	EXPORT_SYMBOL(EtherCAT_activate_slave);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1107	EXPORT_SYMBOL(EtherCAT_deactivate_slave);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1108	EXPORT_SYMBOL(EtherCAT_process_data_cycle);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1109
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1110	/*****************************************************************************/
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1111
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1112	/* Emacs-Konfiguration
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1113	;;; Local Variables: ***
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1114	;;; c-basic-offset:2 ***
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1115	;;; End: ***
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	1116	*/

author	Florian Pose <fp@igh-essen.com>
	Fri, 06 Jan 2006 13:20:29 +0000
changeset 47	ad5f969f263b
parent 43	35120a61d55e
child 48	7e75772ea28c
permissions	-rw-r--r--