etherlabmaster: drivers/ec_master.c@d07ebafe62dd (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
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	25	@param master Zeiger auf den zu initialisierenden
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	26	EtherCAT-Master
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	27
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	28	@return 0 bei Erfolg, sonst < 0 (= dev ist NULL)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	29	*/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	30
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	31	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	32	{
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	33	master->slaves = NULL;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	34	master->slave_count = 0;
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	35	master->dev = NULL;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	36	master->command_index = 0x00;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	37	master->tx_data_length = 0;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	38	master->process_data = NULL;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	39	master->process_data_length = 0;
2 b0a7a4745bf9 ?nderungen an no_rtai r110:110 in drivers gemergt. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	40	master->debug_level = 0;
0 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
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	43	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	44
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	45	/**
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	46	Destruktor eines EtherCAT-Masters.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	47
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	48	Entfernt alle Kommandos aus der Liste, löscht den Zeiger
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	49	auf das Slave-Array und gibt die Prozessdaten frei.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	50
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	51	@param master Zeiger auf den zu löschenden Master
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	52	*/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	53
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	54	void EtherCAT_master_clear(EtherCAT_master_t *master)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	55	{
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	56	// Remove all slaves
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	57	EtherCAT_clear_slaves(master);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	58
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	59	if (master->process_data) {
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	60	kfree(master->process_data);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	61	master->process_data = NULL;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	62	}
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	master->process_data_length = 0;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	65	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	66
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	67	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	68
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	69	/**
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	70	Ö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	71
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	72	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	73
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	74	@param master Der EtherCAT-Master
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	75	@param device Das EtherCAT-Geraet
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	76	@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	77	< 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	78	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	79	*/
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	80
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	81	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	82	EtherCAT_device_t *device)
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	83	{
39 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 \|\| !device) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	85	printk(KERN_ERR "EtherCAT: Illegal parameters"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	86	" for master_open()!\n");
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	87	return -1;
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
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	90	if (master->dev) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	91	printk(KERN_ERR "EtherCAT: Master already"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	92	" has a device.\n");
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	93	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	94	}
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	95
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	96	if (EtherCAT_device_open(device) < 0) {
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	97	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	98	(unsigned int) master->dev);
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	99	return -1;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	100	}
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	master->dev = device;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	103
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	104	return 0;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	105	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	106
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	107	/*****************************************************************************/
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	108
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	109	/**
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	110	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	111
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	112	@param master Der EtherCAT-Master
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	113	@param device Das EtherCAT-Geraet
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	114	*/
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	115
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 29 diff changeset	116	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	117	EtherCAT_device_t *device)
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	118	{
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	119	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	120	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	121	" 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	122	return;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	123	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	124
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	125	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	126	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	127	" Could not close device!\n");
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	128	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	129
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	130	master->dev = NULL;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	131	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	132
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	133	/*****************************************************************************/
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	134
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	135	/**
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	136	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	137	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	138
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	139	@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	140	@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	141
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	142	@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	143	*/
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	144
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	145	int EtherCAT_simple_send_receive(EtherCAT_master_t *master,
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	146	EtherCAT_command_t *cmd)
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	147	{
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	148	unsigned int tries_left;
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	149
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	150	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	151	return -1;
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	152
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	153	udelay(3);
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	154
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	155	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	156
29 8c16582f2394 tries left auf 20 geaendert Wilhelm Hagemeister <hm@igh-essen.com> parents: 27 diff changeset	157	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	158	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	159	&& tries_left)) {
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	160	udelay(1);
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	161	EtherCAT_device_call_isr(master->dev);
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	162	tries_left--;
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	163	}
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	164
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	165	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	166	return -1;
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	167
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	168	return 0;
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	169	}
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	170
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	171	/*****************************************************************************/
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	172
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	Sendet ein einzelnes Kommando in einem Frame.
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	175
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	176	@param master EtherCAT-Master
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	177	@param cmd Kommando zum Senden
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	178
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	179	@return 0 bei Erfolg, sonst < 0
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	180	*/
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	181
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	182	int EtherCAT_simple_send(EtherCAT_master_t *master,
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	183	EtherCAT_command_t *cmd)
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	184	{
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	185	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	186
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	187	if (unlikely(master->debug_level > 0)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	188	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	189	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	190
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	191	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	192	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	193	"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	194	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	195
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	196	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	197	framelength = length + 2;
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 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(framelength > ECAT_FRAME_BUFFER_SIZE)) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	200	printk(KERN_ERR "EtherCAT: Frame too long (%i)!\n",
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	201	framelength);
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	202	return -1;
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	203	}
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	204
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	205	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	206
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	207	if (unlikely(master->debug_level > 0)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	208	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	209	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	210
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	211	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	212	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	213
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	214	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	215	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	216
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	217	if (unlikely(master->debug_level > 0)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	218	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	219	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	220
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	221	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	222
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 + 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	224	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	225	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	226	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	227	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	228	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	229	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	230	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	231	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	232	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	233
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	234	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	235	\|\| 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	236	\|\| 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	237	\|\| 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	238	{
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	239	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	240	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	241	}
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	242	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	243	{
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	244	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	245	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	246
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	247	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	248	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	249
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	250	// 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	251	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	252
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	253	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	254
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	255	if (unlikely(master->debug_level > 0)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	256	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	257	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	258
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	259	// 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	260	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	261	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	262	framelength) != 0)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	263	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	264	return -1;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	265	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	266
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	267	if (unlikely(master->debug_level > 0)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	268	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	269	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	270
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	271	return 0;
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	272	}
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	273
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	274	/*****************************************************************************/
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	275
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	Wartet auf den Empfang eines einzeln gesendeten
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	278	Kommandos.
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	279
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	280	@param master EtherCAT-Master
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	281	@param cmd Gesendetes Kommando
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	282
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	283	@return 0 bei Erfolg, sonst < 0
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	284	*/
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	285
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	286	int EtherCAT_simple_receive(EtherCAT_master_t *master,
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	287	EtherCAT_command_t *cmd)
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	288	{
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	289	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	290	int ret;
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	291	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	292
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	293	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	294	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	295	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	296
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	297	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	298
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	299	if (unlikely(master->rx_data_length < 2)) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	300	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	301	" incomplete EtherCAT header!\n");
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	302	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	303	return -1;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	304	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	305
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	306	// 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	307	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	308	\| (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	309
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	310	if (unlikely(length > master->rx_data_length)) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	311	printk(KERN_ERR "EtherCAT: Received corrupted"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	312	" frame (length does not match)!\n");
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	313	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	314	return -1;
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	315	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	316
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	317	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	318	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	319	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	320	\| ((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	321
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	322	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	323	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	324	" 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	325	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	326	return -1;
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
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	329	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	330	&& 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	331	&& 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	332	&& 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	333	{
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	334	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	335
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	336	// 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	337	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	338
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	339	// Working-Counter setzen
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	340	cmd->working_counter = ((master->rx_data[length + 2 + 10] & 0xFF)
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	341	\| ((master->rx_data[length + 2 + 11] & 0xFF) << 8));
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	342	}
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	343	else
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	344	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	345	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	346	output_debug_data(master);
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	347	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	348
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	349	master->dev->state = ECAT_DS_READY;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	350
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	351	return 0;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	352	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	353
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	354	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	355
17 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	Ü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	358
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	359	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	360	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	361	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	362	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	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	@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	365	@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	366	@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	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	@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	369	*/
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	370
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	371	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	372	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	373	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	374	{
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	375	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	376	EtherCAT_slave_t *cur;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	377	unsigned int i, j, found, length, pos;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	378	unsigned char data[2];
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	379
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	380	if (unlikely(!slave_count)) {
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	381	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	382	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	383	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	384
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	385	// 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	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	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	388
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	389	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	390	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	391
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	392	if (unlikely(cmd.working_counter != slave_count)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	393	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	394	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	395	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	396	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	397	else
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	398	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	399
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	400	// 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	401	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	402	{
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	403	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	404
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	405	if (unlikely(!cur->desc)) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	406	printk(KERN_ERR "EtherCAT: Slave %i has"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	407	" 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	408	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	409	}
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	// 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	412	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	413	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	414
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	415	// 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	416
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	417	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	418	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	419
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	420	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	421	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	422
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	423	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	424	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	425
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	426	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	427	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	428	" 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	429	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	430	}
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	// 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	433
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	434	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	435
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	436	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	437	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	438
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	439	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	440	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	441	" 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	442	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	443	}
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	// Get 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	446	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	447	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	448	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	449
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	450	// 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	451
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	452	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	453	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	454	0x0008,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	455	&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	456	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	457	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	458	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	459	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	460
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	461	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	462	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	463	0x000A,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	464	&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	465	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	466	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	467	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	468	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	469
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	470	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	471	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	472	0x000C,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	473	&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	474	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	475	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	476	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	477	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	478
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	479	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	480	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	481	0x000E,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	482	&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	483	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	484	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	485	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	486	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	487
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	488	// 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	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	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	491
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	492	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	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	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	495	&& 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	496	{
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	497	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	498
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	499	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	500	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	501	" \"%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	502	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	503	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	504	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	505	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	506	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	507
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	508	break;
2 b0a7a4745bf9 ?nderungen an no_rtai r110:110 in drivers gemergt. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	509	}
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	510	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	511
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	512	if (unlikely(!found)) {
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	513	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	514	" (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	515	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	516	return -1;
b0a7a4745bf9 ?nderungen an no_rtai r110:110 in drivers gemergt. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	517	}
b0a7a4745bf9 ?nderungen an no_rtai r110:110 in drivers gemergt. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	518	}
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	519
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	520	length = 0;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	521	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	522	{
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	523	length += slaves[i].desc->data_length;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	524	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	525
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	526	if (unlikely((master->process_data = (unsigned char *)
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	527	kmalloc(sizeof(unsigned char)
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	528	* length, GFP_KERNEL)) == NULL)) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	529	printk(KERN_ERR "EtherCAT: Could not allocate %i"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	530	" bytes for process data.\n", length);
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	531	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	532	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	533
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	534	master->process_data_length = length;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	535	memset(master->process_data, 0x00, length);
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	536
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	537	pos = 0;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	538	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	539	{
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	540	slaves[i].process_data = master->process_data + pos;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	541	slaves[i].logical_address0 = pos;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	542
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	543	printk(KERN_DEBUG "EtherCAT: Slave %i -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	544	" Address 0x%X, \"%s %s\", s/n %u\n",
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	545	i, pos, slaves[i].desc->vendor_name,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	546	slaves[i].desc->product_name,
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	547	slaves[i].serial_number);
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	548
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	549	pos += slaves[i].desc->data_length;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	550	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	551
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	552	master->slaves = slaves;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	553	master->slave_count = 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	554
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	555	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	556	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	557
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	558	/*****************************************************************************/
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	559
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	560	/**
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	561	Entfernt den Zeiger auf das 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	562
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	563	@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	564	*/
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	565
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	566	void EtherCAT_clear_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	567	{
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	568	master->slaves = NULL;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	569	master->slave_count = 0;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	570	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	571
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	572	/*****************************************************************************/
17 1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	573
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	574	/**
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	575	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	576	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	577
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	578	@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	579	@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	580	@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	581	@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	582	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	583
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	584	@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	585	*/
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	586
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	587	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	588	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	589	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	590	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	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	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	593	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	594	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	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	// 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	597
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	598	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	599	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	600	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	601	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	602	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	603	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	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	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	606
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	607	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	608	return -3;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	609
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	610	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	611	printk(KERN_ERR "EtherCAT: SII-read - Slave"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	612	" %04X did not respond!\n", 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	613	return -4;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	614	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	615
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	616	// 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	617	// 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	618	// 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	619
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	620	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	621	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	622	{
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	623	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	624
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	625	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	626
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	627	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	628	return -3;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	629
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	630	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	631	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	632	" Slave %04X did not respond!\n", 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	633	return -4;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	634	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	635
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	636	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	637	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	638	break;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	639	}
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--;
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	642	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	643
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	644	if (unlikely(!tries_left)) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	645	printk(KERN_WARNING "EtherCAT: SSI-read."
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	646	" Slave %04X timed out!\n", 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	647	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	648	}
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	649
1b5aea4d5147 Code zum Senden/Empfangen mehrerer Kommandos in einem Frame vorerst ganz entfernt. Florian Pose <fp@igh-essen.com> parents: 15 diff changeset	650	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	651	}
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	652
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	653	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	654
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	655	/**
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	656	Ändert den Zustand eines Slaves (asynchron).
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	657
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	658	Führt eine (asynchrone) Zustandsänderung bei einem Slave durch.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	659
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	660	@param master EtherCAT-Master
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	661	@param slave Slave, dessen Zustand geändert werden soll
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	662	@param state_and_ack Neuer Zustand, evtl. mit gesetztem
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	663	Acknowledge-Flag
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	664
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	665	@return 0 bei Erfolg, sonst < 0
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	666	*/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	667
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	668	int EtherCAT_state_change(EtherCAT_master_t *master,
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	669	EtherCAT_slave_t *slave,
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	670	unsigned char state_and_ack)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	671	{
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	672	EtherCAT_command_t cmd;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	673	unsigned char data[2];
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	674	unsigned int tries_left;
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	data[0] = state_and_ack;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	677	data[1] = 0x00;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	678
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	679	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	680	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	681
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	682	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	683	printk(KERN_ERR "EtherCAT: Could not set state %02X -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	684	" Unable to send!\n", state_and_ack);
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	685	return -2;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	686	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	687
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	688	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	689	printk(KERN_ERR "EtherCAT: Could not set state %02X -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	690	" Device \"%s %s\" (%d) did not respond!\n",
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	691	state_and_ack, slave->desc->vendor_name,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	692	slave->desc->product_name, slave->ring_position*(-1));
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	693	return -3;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	694	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	695
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	696	slave->requested_state = state_and_ack & 0x0F;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	697
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	698	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	699	while (likely(tries_left))
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	700	{
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	701	udelay(10);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	702
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	703	EtherCAT_command_read(&cmd, slave->station_address, 0x0130, 2);
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	704
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	705	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	706	printk(KERN_ERR "EtherCAT: Could not check"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	707	" state %02X - Unable to send!\n", state_and_ack);
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	708	return -2;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	709	}
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	710
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	711	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	712	printk(KERN_ERR "EtherCAT: Could not check"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	713	" state %02X - Device did not respond!\n",
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	714	state_and_ack);
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	715	return -3;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	716	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	717
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	718	if (unlikely(cmd.data[0] & 0x10)) { // State change error
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	719	printk(KERN_ERR "EtherCAT: Could not set state %02X -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	720	" Device refused state change (code %02X)!\n",
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	721	state_and_ack, cmd.data[0]);
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	722	return -4;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	723	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: 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 (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	726	// State change successful
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	727	break;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	728	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	729
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	730	tries_left--;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	731	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	732
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	733	if (unlikely(!tries_left)) {
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	734	printk(KERN_ERR "EtherCAT: Could not check state %02X -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	735	" Timeout while checking!\n", state_and_ack);
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	736	return -5;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	737	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	738
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	739	slave->current_state = state_and_ack & 0x0F;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	740
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	741	return 0;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	742	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	743
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	744	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	745
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	Konfiguriert einen Slave und setzt den Operational-Zustand.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	748
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	749	Führt eine komplette Konfiguration eines Slaves durch,
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	750	setzt Sync-Manager und FMMU's, führt die entsprechenden
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	751	Zustandsübergänge durch, bis der Slave betriebsbereit ist.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	752
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	753	@param master EtherCAT-Master
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	754	@param slave Zu aktivierender Slave
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	755
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	756	@return 0 bei Erfolg, sonst < 0
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	757	*/
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	int EtherCAT_activate_slave(EtherCAT_master_t *master,
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	760	EtherCAT_slave_t *slave)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	761	{
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	762	EtherCAT_command_t cmd;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	763	const EtherCAT_slave_desc_t *desc;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	764	unsigned char fmmu[16];
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	765	unsigned char data[256];
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	desc = slave->desc;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	768
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	769	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	770	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	771	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	772
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	773	// Resetting FMMU's
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	774
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	775	memset(data, 0x00, 256);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	776
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	777	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	778	0x0600, 256, data);
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	779
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	780	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	781	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	782
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	783	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	784	printk(KERN_ERR "EtherCAT: Resetting FMMUs -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	785	" Slave %04X did not respond!\n",
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	786	slave->station_address);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	787	return -2;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	788	}
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 Sync Manager channels
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	if (desc->type != ECAT_ST_SIMPLE_NOSYNC)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	793	{
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	794	memset(data, 0x00, 256);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	795
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	796	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	797	0x0800, 256, data);
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(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	800	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	801
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	802	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	803	printk(KERN_ERR "EtherCAT: Resetting SMs -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	804	" Slave %04X did not respond!\n",
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	805	slave->station_address);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	806	return -2;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	807	}
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
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	810	// Init Mailbox communication
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	811
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	812	if (desc->type == ECAT_ST_MAILBOX)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	813	{
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	814	if (desc->sm0)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	815	{
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	816	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	817	0x0800, 8, desc->sm0);
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	818
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	819	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	820	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	821
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	822	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	823	printk(KERN_ERR "EtherCAT: Setting SM0 -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	824	" Slave %04X did not respond!\n",
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	825	slave->station_address);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	826	return -3;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	827	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	828	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	829
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	830	if (desc->sm1)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	831	{
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	832	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	833	0x0808, 8, desc->sm1);
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(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	836	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	837
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	838	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	839	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	840	" Slave %04X did not respond!\n",
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	841	slave->station_address);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	842	return -2;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	843	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	844	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	845	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	846
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	847	// Change state to PREOP
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	848
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	849	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	850	ECAT_STATE_PREOP) != 0))
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	851	return -5;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	852
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	853	// Set FMMU's
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	854
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	855	if (desc->fmmu0)
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	memcpy(fmmu, desc->fmmu0, 16);
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	fmmu[0] = slave->logical_address0 & 0x000000FF;
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	860	fmmu[1] = (slave->logical_address0 & 0x0000FF00) >> 8;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	861	fmmu[2] = (slave->logical_address0 & 0x00FF0000) >> 16;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	862	fmmu[3] = (slave->logical_address0 & 0xFF000000) >> 24;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	863
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	864	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	865	0x0600, 16, fmmu);
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	866
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	867	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	868	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	869
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	870	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	871	printk(KERN_ERR "EtherCAT: Setting FMMU0 -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	872	" Slave %04X did not respond!\n",
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	873	slave->station_address);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	874	return -2;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	875	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	876	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	877
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	878	// Set Sync Managers
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	879
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	880	if (desc->type != ECAT_ST_MAILBOX)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	881	{
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	882	if (desc->sm0)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	883	{
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	884	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	885	0x0800, 8, desc->sm0);
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	886
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	887	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	888	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	889
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	890	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	891	printk(KERN_ERR "EtherCAT: Setting SM0 -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	892	" Slave %04X did not respond!\n",
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	893	slave->station_address);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	894	return -3;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	895	}
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
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	898	if (desc->sm1)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	899	{
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	900	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	901	0x0808, 8, desc->sm1);
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	902
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	903	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	904	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	905
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	906	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	907	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	908	" Slave %04X did not respond!\n",
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	909	slave->station_address);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	910	return -3;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	911	}
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	912	}
f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	913	}
f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	914
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	915	if (desc->sm2)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	916	{
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	917	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	918	0x0810, 8, desc->sm2);
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(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	921	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	922
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	923	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	924	printk(KERN_ERR "EtherCAT: Setting SM2 -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	925	" Slave %04X did not respond!\n",
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	926	slave->station_address);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	927	return -3;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	928	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	929	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	930
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	931	if (desc->sm3)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	932	{
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	933	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	934	0x0818, 8, desc->sm3);
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	935
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	936	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	937	return -1;
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	938
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	939	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	940	printk(KERN_ERR "EtherCAT: Setting SM3 -"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	941	" Slave %04X did not respond!\n",
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	942	slave->station_address);
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	943	return -3;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	944	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	945	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	946
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	947	// Change state to SAVEOP
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	948	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	949	ECAT_STATE_SAVEOP) != 0))
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	950	return -12;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	951
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	952	// Change state to OP
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	953	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	954	ECAT_STATE_OP) != 0))
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	955	return -13;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	956
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	957	return 0;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	958	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	959
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	960	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	961
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	962	/**
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	963	Setzt einen Slave zurück in den Init-Zustand.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	964
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	965	@param master EtherCAT-Master
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	966	@param slave Zu deaktivierender Slave
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	967
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	968	@return 0 bei Erfolg, sonst < 0
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
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	971	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	972	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	973	{
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	974	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	975	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	976	return -1;
0 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	return 0;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	979	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	980
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	981	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	982
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	983	/**
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	984	Aktiviert alle Slaves.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	985
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	986	@see EtherCAT_activate_slave
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	987
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	988	@param master EtherCAT-Master
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	989
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	990	@return 0 bei Erfolg, sonst < 0
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	991	*/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	992
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	993	int EtherCAT_activate_all_slaves(EtherCAT_master_t *master)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	994	{
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	995	unsigned int i;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	996
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	997	for (i = 0; i < master->slave_count; i++)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	998	{
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	999	if (unlikely(EtherCAT_activate_slave(master,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1000	&master->slaves[i]) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1001	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1002	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1003
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1004	return 0;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1005	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1006
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1007	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1008
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1009	/**
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1010	Deaktiviert alle Slaves.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1011
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1012	@see EtherCAT_deactivate_slave
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1013
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1014	@param master EtherCAT-Master
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	1015
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1016	@return 0 bei Erfolg, sonst < 0
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1017	*/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1018
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1019	int EtherCAT_deactivate_all_slaves(EtherCAT_master_t *master)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1020	{
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1021	unsigned int i;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1022	int ret = 0;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1023
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1024	for (i = 0; i < master->slave_count; i++)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1025	{
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1026	if (unlikely(EtherCAT_deactivate_slave(master,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1027	&master->slaves[i]) < 0))
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1028	ret = -1;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1029	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1030
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1031	return ret;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1032	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1033
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1034	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1035
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1036	/**
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1037	Sendet alle Prozessdaten an die Slaves.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1038
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1039	Erstellt ein "logical read write"-Kommando mit den
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1040	Prozessdaten des Masters und sendet es an den Bus.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1041
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1042	@param master EtherCAT-Master
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	1043
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1044	@return 0 bei Erfolg, sonst < 0
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1045	*/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1046
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1047	int EtherCAT_write_process_data(EtherCAT_master_t *master)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1048	{
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1049	EtherCAT_command_logical_read_write(&master->process_data_command,
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1050	0, master->process_data_length,
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1051	master->process_data);
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1052
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1053	if (unlikely(EtherCAT_simple_send(master,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1054	&master->process_data_command) < 0))
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1055	{
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1056	printk(KERN_ERR "EtherCAT: Could not send"
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1057	" process data command!\n");
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1058	return -1;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1059	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1060
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1061	return 0;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1062	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: 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	/*****************************************************************************/
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1065
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1066	/**
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1067	Empfängt alle Prozessdaten von den Slaves.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1068
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1069	Empfängt ein zuvor gesendetes "logical read write"-Kommando
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1070	und kopiert die empfangenen daten in den Prozessdatenspeicher
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1071	des Masters.
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1072
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1073	@param master EtherCAT-Master
8 f2ebe943c686 Spaces am Zeilenende entfernt. Florian Pose <fp@igh-essen.com> parents: 6 diff changeset	1074
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1075	@return 0 bei Erfolg, sonst < 0
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1076	*/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1077
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1078	int EtherCAT_read_process_data(EtherCAT_master_t *master)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1079	{
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1080	unsigned int tries_left;
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1081
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1082	EtherCAT_device_call_isr(master->dev);
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1083
29 8c16582f2394 tries left auf 20 geaendert Wilhelm Hagemeister <hm@igh-essen.com> parents: 27 diff changeset	1084	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	1085	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	1086	&& tries_left))
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1087	{
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1088	udelay(1);
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1089	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	1090	tries_left--;
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1091	}
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1092
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1093	if (unlikely(!tries_left))
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1094	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1095	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	1096	return -1;
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	if (unlikely(EtherCAT_simple_receive(master,
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1100	&master->process_data_command) < 0))
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1101	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1102	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	1103	return -1;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1104	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1105
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1106	if (unlikely(master->process_data_command.state != ECAT_CS_RECEIVED))
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1107	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1108	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	1109	return -1;
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1110	}
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1111
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1112	// Daten von Kommando in Prozessdaten des Master kopieren
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1113	memcpy(master->process_data, master->process_data_command.data,
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1114	master->process_data_length);
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1115
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1116	return 0;
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1117	}
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1118
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1119	/*****************************************************************************/
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1120
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1121	/**
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1122	Verwirft das zuletzt gesendete Prozessdatenkommando.
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1123
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1124	@param master EtherCAT-Master
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1125	*/
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1126
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1127	void EtherCAT_clear_process_data(EtherCAT_master_t *master)
db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1128	{
6 e36a85dc2730 ISR-Aufruf in read_process_data Wilhelm Hagemeister <hm@igh-essen.com> parents: 5 diff changeset	1129	EtherCAT_device_call_isr(master->dev);
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 11 diff changeset	1130	master->dev->state = ECAT_DS_READY;
2 b0a7a4745bf9 ?nderungen an no_rtai r110:110 in drivers gemergt. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	1131	}
b0a7a4745bf9 ?nderungen an no_rtai r110:110 in drivers gemergt. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	1132
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1133	/*****************************************************************************/
2 b0a7a4745bf9 ?nderungen an no_rtai r110:110 in drivers gemergt. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	1134
b0a7a4745bf9 ?nderungen an no_rtai r110:110 in drivers gemergt. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	1135	/**
11 e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	1136	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	1137
20 7dd6216fb7cf Dokumentation angeglichen. Florian Pose <fp@igh-essen.com> parents: 19 diff changeset	1138	@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	1139	*/
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	1140
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1141	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	1142	{
e58d78234412 EtherCAT_send_receive_command() zum Senden eines einzelnen Kommandos hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 8 diff changeset	1143	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	1144
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1145	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	1146	master->tx_data_length);
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1147
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1148	printk(KERN_DEBUG);
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1149	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	1150	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1151	printk("%02X ", master->tx_data[i]);
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1152	if ((i + 1) % 16 == 0) printk("\n" KERN_DEBUG);
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1153	}
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1154	printk("\n");
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1155
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1156	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	1157	master->rx_data_length);
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1158
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1159	printk(KERN_DEBUG);
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1160	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	1161	{
26 60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1162	printk("%02X ", master->rx_data[i]);
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1163	if ((i + 1) % 16 == 0) printk("\n" KERN_DEBUG);
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1164	}
60435f959e5c Serial-Debugger entfernt. Florian Pose <fp@igh-essen.com> parents: 24 diff changeset	1165	printk("\n");
19 a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1166	}
a51289e6cb2d Warten beim Empfangen der Prozessdaten, Bugfix und kleinere Verbesserungen. Florian Pose <fp@igh-essen.com> parents: 17 diff changeset	1167
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1168	/*****************************************************************************/
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	1169
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	1170	EXPORT_SYMBOL(EtherCAT_master_init);
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	1171	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	1172	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	1173	EXPORT_SYMBOL(EtherCAT_master_close);
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	1174	EXPORT_SYMBOL(EtherCAT_read_process_data);
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	1175	EXPORT_SYMBOL(EtherCAT_write_process_data);
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	1176	EXPORT_SYMBOL(EtherCAT_check_slaves);
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	1177	EXPORT_SYMBOL(EtherCAT_activate_all_slaves);
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	1178	EXPORT_SYMBOL(EtherCAT_clear_process_data);
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	1179	EXPORT_SYMBOL(EtherCAT_deactivate_all_slaves);
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 26 diff changeset	1180
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 35 diff changeset	1181	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Fri, 23 Dec 2005 08:20:10 +0000
changeset 40	d07ebafe62dd
parent 39	6965c23a6826
child 42	a22a202d0f42
permissions	-rw-r--r--