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

author	Florian Pose <fp@igh-essen.com>
	Fri, 20 Jan 2006 17:50:35 +0000
changeset 57	bae4965439b8
parent 56	36d1fa37f5e1
child 58	21b7342e2a90
permissions	-rw-r--r--