etherlabmaster: mini/ec_mini.c@d417dd9bdc2f (annotated)

0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	1	/******************************************************************************
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	2	*
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	3	* ec_mini.c
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	4	*
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	5	* Minimalmodul für EtherCAT
13 db0742533c10 Simple Send/Receive Funktionen. Florian Pose <fp@igh-essen.com> parents: 5 diff changeset	6	*
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	7	* $Id$
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	8	*
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	9	******************************************************************************/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	10
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	11	#include <linux/module.h>
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	12	//#include <linux/slab.h>
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	13	#include <linux/delay.h>
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	14	#include <linux/timer.h>
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	15
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	16	#include "../drivers/ec_master.h"
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	17	#include "../drivers/ec_device.h"
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	18	#include "../drivers/ec_types.h"
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	19	#include "../drivers/ec_dbg.h"
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	20
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	21	/******************************************************************************/
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	22
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	23	#define ECAT
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	24
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	25	#define ECAT_OPEN
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	26	#define ECAT_MASTER
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	27	#define ECAT_SLAVES
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	28	#define ECAT_CYCLIC_DATA
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	29
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	30	/******************************************************************************/
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	31
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	32	#ifdef ECAT
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	33
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	34	extern EtherCAT_device_t rtl_ecat_dev;
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	35
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	36	#ifdef ECAT_MASTER
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	37	static EtherCAT_master_t *ecat_master = NULL;
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	38	#endif
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	39
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	40	#ifdef ECAT_SLAVES
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	41	static EtherCAT_slave_t ecat_slaves[] =
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	42	{
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	43	#if 0
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	44	// Block 1
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	45	ECAT_INIT_SLAVE(Beckhoff_EK1100),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	46	ECAT_INIT_SLAVE(Beckhoff_EL4102),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	47	ECAT_INIT_SLAVE(Beckhoff_EL3162),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	48	ECAT_INIT_SLAVE(Beckhoff_EL1014),
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	49
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	50	ECAT_INIT_SLAVE(Beckhoff_EL4102),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	51	ECAT_INIT_SLAVE(Beckhoff_EL4102),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	52	ECAT_INIT_SLAVE(Beckhoff_EL4102),
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	53
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	54	ECAT_INIT_SLAVE(Beckhoff_EL3162),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	55	ECAT_INIT_SLAVE(Beckhoff_EL3162),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	56	ECAT_INIT_SLAVE(Beckhoff_EL3162),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	57	ECAT_INIT_SLAVE(Beckhoff_EL3102),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	58	ECAT_INIT_SLAVE(Beckhoff_EL3102),
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	59	ECAT_INIT_SLAVE(Beckhoff_EL3102),
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	60
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	61	#endif
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	62
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	63	#if 1
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	64	// Block 2
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	65	ECAT_INIT_SLAVE(Beckhoff_EK1100),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	66	ECAT_INIT_SLAVE(Beckhoff_EL4102),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	67	ECAT_INIT_SLAVE(Beckhoff_EL1014),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	68	ECAT_INIT_SLAVE(Beckhoff_EL3162),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	69	ECAT_INIT_SLAVE(Beckhoff_EL2004),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	70	ECAT_INIT_SLAVE(Beckhoff_EL3102),
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	71	ECAT_INIT_SLAVE(Beckhoff_EL2004),
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	72	ECAT_INIT_SLAVE(Beckhoff_EL2004),
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	73	ECAT_INIT_SLAVE(Beckhoff_EL2004),
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	74	ECAT_INIT_SLAVE(Beckhoff_EL2004),
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	75	ECAT_INIT_SLAVE(Beckhoff_EL2004),
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	76
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	77	// Block 3
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	78	ECAT_INIT_SLAVE(Beckhoff_EK1100),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	79	ECAT_INIT_SLAVE(Beckhoff_EL1014),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	80	ECAT_INIT_SLAVE(Beckhoff_EL1014),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	81	ECAT_INIT_SLAVE(Beckhoff_EL1014),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	82	ECAT_INIT_SLAVE(Beckhoff_EL1014),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	83	ECAT_INIT_SLAVE(Beckhoff_EL1014),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	84	ECAT_INIT_SLAVE(Beckhoff_EL2004),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	85	ECAT_INIT_SLAVE(Beckhoff_EL2004),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	86	ECAT_INIT_SLAVE(Beckhoff_EL2004),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	87	ECAT_INIT_SLAVE(Beckhoff_EL2004),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	88	ECAT_INIT_SLAVE(Beckhoff_EL1014),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	89	ECAT_INIT_SLAVE(Beckhoff_EL1014),
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	90	ECAT_INIT_SLAVE(Beckhoff_EL1014)
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	91	#endif
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	92	};
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	93
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	94	#define ECAT_SLAVES_COUNT (sizeof(ecat_slaves) / sizeof(EtherCAT_slave_t))
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	95
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	96	#endif // ECAT_SLAVES
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	97
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	98	#endif // ECAT
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	99
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	100	#ifdef ECAT_CYCLIC_DATA
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	101
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	102	int value;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	103	int dig1;
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	104
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	105	struct timer_list timer;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	106	unsigned long last_start_jiffies;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	107
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	108	#endif // ECAT_CYCLIC_DATA
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	109
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	110	/******************************************************************************
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	111	*
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	112	* Function: next2004
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	113	*
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	114	*****************************************************************************/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	115
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	116	#ifdef ECAT
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	117	#ifdef ECAT_CYCLIC_DATA
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	118
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	119	static int next2004(int *wrap)
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	120	{
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	121	static int i = 0;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	122	unsigned int j = 0;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	123
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	124	*wrap = 0;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	125
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	126	for (j = 0; j < ECAT_SLAVES_COUNT; j++)
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	127	{
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	128	i++;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	129
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	130	i %= ECAT_SLAVES_COUNT;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	131
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	132	if (i == 0) *wrap = 1;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	133
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	134	if (ecat_slaves[i].desc == Beckhoff_EL2004)
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	135	{
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	136	return i;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	137	}
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	138	}
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	139
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	140	return -1;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	141	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	142	#endif
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	143	#endif
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	144
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	145	/******************************************************************************
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	146	*
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	147	* Function: run
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	148	*
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	149	* Beschreibung: Zyklischer Prozess
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	150	*
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	151	*****************************************************************************/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	152
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	153	#ifdef ECAT_CYCLIC_DATA
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	154
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	155	static void run(unsigned long data)
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	156	{
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	157	#ifdef ECAT
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	158	static int ms = 0;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	159	static int cnt = 0;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	160	static unsigned long int k = 0;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	161	static int firstrun = 1;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	162
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	163	static int klemme = 0;
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	164	static int kanal = 0;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	165	static int up_down = 0;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	166	int wrap = 0;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	167
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	168	ms++;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	169	ms %= 1000;
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	170
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	171	#if 0
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	172	ecat_tx_delay = ((unsigned int) (100000 / HZ) * (ecat_master->dev->tx_time-k))
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	173	/ (current_cpu_data.loops_per_jiffy / 10);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	174	ecat_rx_delay = ((unsigned int) (100000 / HZ) * (ecat_master->dev->rx_time-k))
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	175	/ (current_cpu_data.loops_per_jiffy / 10);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	176
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	177	rx_intr = ecat_master->dev->rx_intr_cnt;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	178	tx_intr = ecat_master->dev->tx_intr_cnt;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	179	total_intr = ecat_master->dev->intr_cnt;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	180	#endif
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	181
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	182	// Prozessdaten lesen
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	183	if (!firstrun)
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	184	{
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	185	EtherCAT_read_process_data(ecat_master);
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	186
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	187	// Daten lesen und skalieren
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	188	// value = EtherCAT_read_value(&ecat_master->slaves[5], 0) / 3276; //.7; FIXME kein FP im Kernel ohne Schutz !!
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	189	// dig1 = EtherCAT_read_value(&ecat_master->slaves[3], 0);
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	190	}
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	191	else
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	192	klemme = next2004(&wrap);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	193
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	194
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	195	#if 0
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	196	// Daten schreiben
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	197	EtherCAT_write_value(&ecat_master->slaves[4], 0, ms > 500 ? 1 : 0);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	198	EtherCAT_write_value(&ecat_master->slaves[4], 1, ms > 500 ? 0 : 1);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	199	EtherCAT_write_value(&ecat_master->slaves[4], 2, ms > 500 ? 0 : 1);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	200	EtherCAT_write_value(&ecat_master->slaves[4], 3, ms > 500 ? 1 : 0);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	201	#endif
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	202
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	203	if (cnt++ > 20)
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	204	{
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	205	cnt = 0;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	206
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	207	if (++kanal > 3)
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	208	{
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	209	kanal = 0;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	210	klemme = next2004(&wrap);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	211
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	212	if (wrap == 1)
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	213	{
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	214	if (up_down == 1) up_down = 0;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	215	else up_down = 1;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	216	}
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	217	}
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	218	}
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	219
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	220	if (klemme >= 0) {
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	221	EtherCAT_write_value(&ecat_master->slaves[klemme], kanal,up_down);
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	222	//printk("ECAT write: Klemme: %d, Kanal: %d, Wert: %d\n",klemme,kanal,up_down);
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	223	}
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	224
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	225	#if 0
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	226	EtherCAT_write_value(&ecat_master->slaves[13], 1, ms > 500 ? 0 : 1);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	227	EtherCAT_write_value(&ecat_master->slaves[14], 2, ms > 500 ? 0 : 1);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	228	EtherCAT_write_value(&ecat_master->slaves[15], 3, ms > 500 ? 1 : 0);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	229	#endif
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	230
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	231	// Prozessdaten schreiben
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	232	rdtscl(k);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	233	EtherCAT_write_process_data(ecat_master);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	234	firstrun = 0;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	235	#endif
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	236
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	237	timer.expires += HZ / 1000;
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	238	add_timer(&timer);
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	239	}
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	240
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	241	#endif // ECAT_CYCLIC_DATA
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	242
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	243	/******************************************************************************
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	244	*
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	245	* Function: init
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	246	*
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	247	******************************************************************************/
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	248
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	249	int __init init_module()
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	250	{
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	251	#ifdef ECAT
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	252	#ifdef ECAT_OPEN
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	253	int rv = -1;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	254	#endif
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	255	#endif
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	256
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	257	EC_DBG(KERN_INFO "=== Starting Minimal EtherCAT environment... ===\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	258
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	259	#ifdef ECAT
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	260
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	261	EtherCAT_device_debug(&rtl_ecat_dev);
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	262
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	263	#ifdef ECAT_OPEN
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	264	EC_DBG("Opening EtherCAT device.\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	265
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	266	// HIER PASSIERT DER FEHLER:
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	267	if (EtherCAT_device_open(&rtl_ecat_dev) < 0)
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	268	{
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	269	EC_DBG(KERN_ERR "msr_modul: Could not initialize EtherCAT NIC.\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	270	goto out_nothing;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	271	}
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	272
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	273	if (!rtl_ecat_dev.dev) // Es gibt kein EtherCAT-Device
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	274	{
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	275	EC_DBG(KERN_ERR "msr_modul: No EtherCAT device!\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	276	goto out_close;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	277	}
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	278	#endif // ECAT_OPEN
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	279
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	280	#ifdef ECAT_MASTER
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	281	EC_DBG("Initialising EtherCAT master\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	282
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	283	if ((ecat_master = (EtherCAT_master_t *) kmalloc(sizeof(EtherCAT_master_t), GFP_KERNEL)) == 0)
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	284	{
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	285	EC_DBG(KERN_ERR "msr_modul: Could not alloc memory for EtherCAT master!\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	286	goto out_close;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	287	}
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	288
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	289	if (EtherCAT_master_init(ecat_master, &rtl_ecat_dev) < 0)
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	290	{
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	291	EC_DBG(KERN_ERR "EtherCAT could not init master!\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	292	goto out_master;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	293	}
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	294
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	295	//ecat_master->debug_level = 1;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	296
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	297	#endif // ECAT_MASTER
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	298
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	299	#ifdef ECAT_SLAVES
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	300	EC_DBG("Checking EtherCAT slaves.\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	301
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	302	if (EtherCAT_check_slaves(ecat_master, ecat_slaves, ECAT_SLAVES_COUNT) != 0)
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	303	{
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	304	EC_DBG(KERN_ERR "EtherCAT: Could not init slaves!\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	305	goto out_masterclear;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	306	}
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	307
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	308	EC_DBG("Activating all EtherCAT slaves.\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	309
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	310	if (EtherCAT_activate_all_slaves(ecat_master) != 0)
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	311	{
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	312	EC_DBG(KERN_ERR "EtherCAT: Could not activate slaves!\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	313	goto out_masterclear;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	314	}
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	315	#endif
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	316
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	317	#endif // ECAT
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	318
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	319	#ifdef ECAT_CYCLIC_DATA
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	320	EC_DBG("Starting cyclic sample thread.\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	321
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	322	schedule();
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	323	mdelay(1000);
d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	324	schedule();
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	325	init_timer(&timer);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	326
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	327	timer.function = run;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	328	timer.data = 0;
24 d417dd9bdc2f Wilhelms ?nderungen ?bernommen. Florian Pose <fp@igh-essen.com> parents: 23 diff changeset	329	timer.expires = jiffies+10; // Das erste Mal sofort feuern
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	330	last_start_jiffies = timer.expires;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	331	add_timer(&timer);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	332
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	333	EC_DBG("Initialised sample thread.\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	334	#endif
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	335
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	336	EC_DBG(KERN_INFO "=== Minimal EtherCAT environment started. ===\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	337
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	338	return 0;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	339
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	340	#ifdef ECAT
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	341
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	342	#ifdef ECAT_SLAVES
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	343	out_masterclear:
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	344	EC_DBG(KERN_INFO "Clearing EtherCAT master.\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	345	EtherCAT_master_clear(ecat_master);
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	346	#endif
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	347
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	348	#ifdef ECAT_MASTER
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	349	out_master:
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	350	EC_DBG(KERN_INFO "Freeing EtherCAT master.\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	351	kfree(ecat_master);
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	352	#endif
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	353
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	354	#ifdef ECAT_OPEN
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	355	out_close:
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	356	EC_DBG(KERN_INFO "Closing device.\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	357	EtherCAT_device_close(&rtl_ecat_dev);
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	358
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	359	out_nothing:
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	360	return rv;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	361	#endif
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	362
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	363	#endif // ECAT
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	364	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	365
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	366	/******************************************************************************
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	367	*
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	368	* Function: cleanup
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	369	*
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	370	******************************************************************************/
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	371
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	372	void __exit cleanup_module()
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	373	{
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	374	EC_DBG(KERN_INFO "=== Stopping Minimal EtherCAT environment... ===\n");
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	375
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	376	#ifdef ECAT_MASTER
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	377
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	378	#ifdef ECAT
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	379	if (ecat_master)
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	380	{
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	381	#endif
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	382	//ecat_master->debug_level = 1;
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	383
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	384	#ifdef ECAT_CYCLIC_DATA
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	385
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	386	del_timer_sync(&timer);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	387
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	388	#ifdef ECAT
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	389	EtherCAT_clear_process_data(ecat_master);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	390	#endif
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	391
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	392	#endif // ECAT_CYCLIC_DATA
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	393
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	394	#ifdef ECAT
5 6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	395
6f2508af550c Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert. Florian Pose <fp@igh-essen.com> parents: 0 diff changeset	396	#ifdef ECAT_SLAVES
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	397	EC_DBG(KERN_INFO "Deactivating slaves.\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	398	EtherCAT_deactivate_all_slaves(ecat_master);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	399	#endif
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	400
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	401	EC_DBG(KERN_INFO "Clearing EtherCAT master.\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	402	EtherCAT_master_clear(ecat_master);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	403
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	404	EC_DBG(KERN_INFO "Freeing EtherCAT master.\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	405	kfree(ecat_master);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	406	ecat_master = NULL;
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	407	}
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	408	#endif // ECAT
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	409
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	410	#endif // ECAT_MASTER
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	411
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	412	#ifdef ECAT
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	413	#ifdef ECAT_OPEN
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	414	EC_DBG(KERN_INFO "Closing device.\n");
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	415	EtherCAT_device_close(&rtl_ecat_dev);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	416	#endif
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	417	#endif
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	418
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	419	EC_DBG(KERN_INFO "=== Minimal EtherCAT environment stopped. ===\n");
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	420	}
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	421
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	422	/*****************************************************************************/
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	423
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	424	MODULE_LICENSE("GPL");
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	425	MODULE_AUTHOR ("Florian Pose <fp@igh-essen.com>");
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	426	MODULE_DESCRIPTION ("Minimal EtherCAT environment");
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	427
22 e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	428	module_init(init_module);
e8c2cd004e0b Portierung der Module in drivers/ und mini/ nach Kernel 2.6. Florian Pose <fp@igh-essen.com> parents: 13 diff changeset	429	module_exit(cleanup_module);
0 05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	430
05c992bf5847 trunk, tags und branches Florian Pose <fp@igh-essen.com> parents: diff changeset	431	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Fri, 02 Dec 2005 09:03:32 +0000
branch	kernel2.6
changeset 24	d417dd9bdc2f
parent 23	39364fbcd069
child 26	60435f959e5c
permissions	-rw-r--r--