etherlabmaster: rt/msr_module.c@ad5f969f263b (annotated)

42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	1	/******************************************************************************
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	2	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	3	* msr_module.c
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	4	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	5	* Kernelmodul für 2.6 Kernel zur Meßdatenerfassung, Steuerung und Regelung.
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	6	*
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	7	* Autor: Wilhelm Hagemeister, Florian Pose
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	8	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	9	* (C) Copyright IgH 2002
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	10	* Ingenieurgemeinschaft IgH
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	11	* Heinz-Bäcker Str. 34
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	12	* D-45356 Essen
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	13	* Tel.: +49 201/61 99 31
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	14	* Fax.: +49 201/61 98 36
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	15	* E-mail: hm@igh-essen.com
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	16	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	17	* $Id$
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	18	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	19	*****************************************************************************/
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	20
45 f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	21	// Linux
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	22	#include <linux/module.h>
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	23	#include <linux/ipipe.h>
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	24
45 f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	25	// RT_lib
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	26	#include <msr_main.h>
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	27	#include <msr_utils.h>
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	28	#include <msr_messages.h>
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	29	#include <msr_float.h>
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	30	#include <msr_reg.h>
45 f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	31	#include "msr_param.h"
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	32	#include "msr_jitter.h"
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	33
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	34	// EtherCAT
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	35	#include "../drivers/ec_master.h"
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	36	#include "../drivers/ec_device.h"
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	37	#include "../drivers/ec_types.h"
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	38	#include "../drivers/ec_module.h"
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	39
45 f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	40	// Defines/Makros
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	41	#define TSC2US(T1, T2) ((T2 - T1) * 1000UL / cpu_khz)
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	42	#define HZREDUCTION (MSR_ABTASTFREQUENZ / HZ)
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	43
45 f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	44	/*****************************************************************************/
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	45	/* Globale Variablen */
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	46
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	47	// RT_lib
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	48	extern struct timeval process_time;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	49	struct timeval msr_time_increment; // Increment per Interrupt
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	50
45 f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	51	// Adeos
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	52	static struct ipipe_domain this_domain;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	53	static struct ipipe_sysinfo sys_info;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	54
45 f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	55	// EtherCAT
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	56
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	57	static EtherCAT_master_t *ecat_master = NULL;
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	58	static unsigned int ecat_bus_time = 0;
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	59	static unsigned int ecat_timeouts = 0;
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	60
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	61	static EtherCAT_slave_t ecat_slaves[] =
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	62	{
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	63	// Block 1
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	64	ECAT_INIT_SLAVE(Beckhoff_EK1100, 0),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	65	ECAT_INIT_SLAVE(Beckhoff_EL4102, 0),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	66	ECAT_INIT_SLAVE(Beckhoff_EL1014, 0),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	67	ECAT_INIT_SLAVE(Beckhoff_EL3162, 0),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	68	ECAT_INIT_SLAVE(Beckhoff_EL2004, 0),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	69	ECAT_INIT_SLAVE(Beckhoff_EL3102, 0),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	70	ECAT_INIT_SLAVE(Beckhoff_EL2004, 0),
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	71
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	72	// Block 2
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	73	ECAT_INIT_SLAVE(Beckhoff_EK1100, 1),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	74	ECAT_INIT_SLAVE(Beckhoff_EL1014, 1),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	75	ECAT_INIT_SLAVE(Beckhoff_EL1014, 1),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	76	ECAT_INIT_SLAVE(Beckhoff_EL1014, 1),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	77	ECAT_INIT_SLAVE(Beckhoff_EL1014, 1),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	78	ECAT_INIT_SLAVE(Beckhoff_EL1014, 1),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	79	ECAT_INIT_SLAVE(Beckhoff_EL2004, 1),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	80	ECAT_INIT_SLAVE(Beckhoff_EL2004, 1),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	81	ECAT_INIT_SLAVE(Beckhoff_EL2004, 1),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	82	ECAT_INIT_SLAVE(Beckhoff_EL2004, 1),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	83	ECAT_INIT_SLAVE(Beckhoff_EL1014, 1),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	84	ECAT_INIT_SLAVE(Beckhoff_EL1014, 1),
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	85	ECAT_INIT_SLAVE(Beckhoff_EL1014, 1)
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	86	};
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	87
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	88	#define ECAT_SLAVES_COUNT (sizeof(ecat_slaves) / sizeof(EtherCAT_slave_t))
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	89
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	90	#define USE_MSR_LIB
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	91
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	92	#ifdef USE_MSR_LIB
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	93	double value;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	94	int dig1;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	95	#endif
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	96
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	97	/******************************************************************************
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	98	*
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	99	* Function: next2004
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	100	*
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	101	*****************************************************************************/
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	102
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	103	static int next2004(int *wrap)
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	104	{
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	105	static int i = 0;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	106	unsigned int j = 0;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	107
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	108	*wrap = 0;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	109
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	110	for (j = 0; j < ECAT_SLAVES_COUNT; j++)
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	111	{
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	112	i++;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	113
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	114	i %= ECAT_SLAVES_COUNT;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	115
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	116	if (i == 0) *wrap = 1;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	117
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	118	if (ecat_slaves[i].desc == Beckhoff_EL2004)
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	119	{
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	120	return i;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	121	}
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	122	}
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	123
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	124	return -1;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	125	}
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	126
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	127	/******************************************************************************
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	128	*
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	129	* Function: msr_controller_run()
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	130	*
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	131	*****************************************************************************/
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	132
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	133	static void msr_controller_run(void)
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	134	{
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	135	static int ms = 0;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	136	static int cnt = 0;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	137	static int firstrun = 1;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	138
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	139	static int klemme = 0;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	140	static int kanal = 0;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	141	static int up_down = 0;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	142	int wrap = 0;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	143
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	144	static unsigned int debug_counter = 0;
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	145	unsigned long t1, t2, t3;
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	146	unsigned int bustime1, bustime2;
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	147	static unsigned long lt = 0;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	148
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	149	rdtscl(t1);
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	150
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	151	// Prozessdaten lesen
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	152	msr_jitter_run(MSR_ABTASTFREQUENZ);
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	153
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	154	if (firstrun) klemme = next2004(&wrap);
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	155
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	156	ms++;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	157	ms %= 1000;
40 d07ebafe62dd 20kHz, Wilhelm Florian Pose <fp@igh-essen.com> parents: 38 diff changeset	158	if (cnt++ > 200)
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	159	{
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	160	cnt = 0;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	161
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	162	if (++kanal > 3)
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	163	{
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	164	kanal = 0;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	165	klemme = next2004(&wrap);
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	166
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	167	if (wrap == 1)
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	168	{
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	169	if (up_down == 1) up_down = 0;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	170	else up_down = 1;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	171	}
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	172	}
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	173	}
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	174
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	175	if (klemme >= 0) {
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	176	EtherCAT_write_value(&ecat_slaves[klemme], kanal, up_down);
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	177	}
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	178
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	179	// Prozessdaten schreiben
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	180
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	181	rdtscl(t2);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	182
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	183	if (EtherCAT_process_data_cycle(ecat_master, 0, 40) < 0)
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	184	ecat_timeouts++;
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	185	bustime1 = ecat_master->bus_time;
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	186
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	187	if (EtherCAT_process_data_cycle(ecat_master, 1, 40) < 0)
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	188	ecat_timeouts++;
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	189	bustime2 = ecat_master->bus_time;
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	190
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	191	rdtscl(t3);
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	192
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	193	ecat_bus_time = TSC2US(t2, t3);
45 f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	194
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	195	// Daten lesen und skalieren
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	196	#ifdef USE_MSR_LIB
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	197	value = EtherCAT_read_value(&ecat_slaves[5], 0) / 3276.0;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	198	dig1 = EtherCAT_read_value(&ecat_slaves[2], 0);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	199	#endif
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	200
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	201	if (debug_counter == MSR_ABTASTFREQUENZ) {
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	202	printk(KERN_DEBUG "%lu: %luŽµs + %uŽµs + %uŽµs = %luŽµs\n", TSC2US(lt, t1),
ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	203	TSC2US(t1, t2), bustime1, bustime2, TSC2US(t1, t3));
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	204	debug_counter = 0;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	205	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	206
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	207	lt = t1;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	208
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	209	firstrun = 0;
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	210	debug_counter++;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	211	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	212
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	213	/******************************************************************************
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	214	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	215	* Function: msr_run(_interrupt)
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	216	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	217	* Beschreibung: Routine wird zyklisch im Timerinterrupt ausgeführt
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	218	* (hier muß alles rein, was Echtzeit ist ...)
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	219	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	220	* Parameter: Zeiger auf msr_data
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	221	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	222	* Rückgabe:
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	223	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	224	* Status: exp
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	225	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	226	*****************************************************************************/
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	227
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	228	void msr_run(unsigned irq)
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	229	{
45 f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	230	static int counter = 0;
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	231
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	232	#ifdef USE_MSR_LIB
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	233	timeval_add(&process_time, &process_time, &msr_time_increment);
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	234	MSR_ADEOS_INTERRUPT_CODE(msr_controller_run(); msr_write_kanal_list(););
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	235	#else
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	236	msr_controller_run();
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	237	#endif
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	238
40 d07ebafe62dd 20kHz, Wilhelm Florian Pose <fp@igh-essen.com> parents: 38 diff changeset	239	ipipe_control_irq(irq,0,IPIPE_ENABLE_MASK); //Interrupt bestŽätigen
45 f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	240	if (counter++ > HZREDUCTION) {
40 d07ebafe62dd 20kHz, Wilhelm Florian Pose <fp@igh-essen.com> parents: 38 diff changeset	241	ipipe_propagate_irq(irq); //und weiterreichen
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	242	counter = 0;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	243	}
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	244	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	245
45 f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	246	/*****************************************************************************/
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	247
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	248	void domain_entry(void)
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	249	{
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	250	printk("Domain %s started.\n", ipipe_current_domain->name);
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	251
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	252	ipipe_get_sysinfo(&sys_info);
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	253	ipipe_virtualize_irq(ipipe_current_domain,sys_info.archdep.tmirq,
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	254	&msr_run, NULL, IPIPE_HANDLE_MASK);
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	255
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	256	ipipe_tune_timer(1000000000UL/MSR_ABTASTFREQUENZ,0);
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	257	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	258
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	259	/******************************************************************************
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	260	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	261	* Function: msr_register_channels
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	262	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	263	* Beschreibung: KanŽäle registrieren
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	264	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	265	* Parameter:
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	266	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	267	* RŽückgabe:
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	268	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	269	* Status: exp
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	270	*
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	271	*****************************************************************************/
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	272
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	273	int msr_globals_register(void)
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	274	{
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	275	#ifdef USE_MSR_LIB
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	276	msr_reg_kanal("/value", "V", &value, TDBL);
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	277	msr_reg_kanal("/dig1", "", &dig1, TINT);
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	278	#endif
45 f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	279
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	280	msr_reg_kanal("/Taskinfo/EtherCAT/BusTime", "us", &ecat_bus_time, TUINT);
47 ad5f969f263b Prozessdatentimeout, Buszeit und weniger Klemmen. Florian Pose <fp@igh-essen.com> parents: 45 diff changeset	281	msr_reg_kanal("/Taskinfo/EtherCAT/Timeouts", "", &ecat_timeouts, TUINT);
45 f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	282
f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	283	return 0;
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	284	}
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	285
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	286	/******************************************************************************
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	287	* the init/clean material
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	288	*****************************************************************************/
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	289
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	290	int __init init_module()
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	291	{
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	292	unsigned int i;
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	293	struct ipipe_domain_attr attr; //ipipe
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	294
36 6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	295	// Als allererstes die RT-lib initialisieren
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	296	#ifdef USE_MSR_LIB
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	297	if (msr_rtlib_init(1,MSR_ABTASTFREQUENZ,10,&msr_globals_register) < 0) {
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	298	msr_print_warn("msr_modul: can't initialize rtlib!");
36 6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	299	goto out_return;
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	300	}
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	301	#endif
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	302
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	303	msr_jitter_init();
36 6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	304
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	305	printk(KERN_INFO "=== Starting EtherCAT environment... ===\n");
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	306
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	307	if ((ecat_master = EtherCAT_request(0)) == NULL) {
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	308	printk(KERN_ERR "EtherCAT master 0 not available!\n");
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	309	goto out_msr_cleanup;
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	310	}
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	311
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	312	printk("Checking EtherCAT slaves.\n");
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	313
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	314	if (EtherCAT_check_slaves(ecat_master, ecat_slaves, ECAT_SLAVES_COUNT) != 0) {
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	315	printk(KERN_ERR "EtherCAT: Could not init slaves!\n");
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	316	goto out_release_master;
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	317	}
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	318
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	319	printk("Activating all EtherCAT slaves.\n");
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	320
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	321	for (i = 0; i < ECAT_SLAVES_COUNT; i++) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	322	if (EtherCAT_activate_slave(ecat_master, ecat_slaves + i) < 0) {
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	323	printk(KERN_ERR "EtherCAT: Could not activate slave %i!\n", i);
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	324	goto out_release_master;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	325	}
36 6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	326	}
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	327
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	328	do_gettimeofday(&process_time);
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	329	msr_time_increment.tv_sec=0;
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	330	msr_time_increment.tv_usec=(unsigned int)(1000000/MSR_ABTASTFREQUENZ);
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	331
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	332	ipipe_init_attr (&attr);
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	333	attr.name = "IPIPE-MSR-MODULE";
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	334	attr.priority = IPIPE_ROOT_PRIO + 1;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	335	attr.entry = &domain_entry;
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	336	ipipe_register_domain(&this_domain,&attr);
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	337
36 6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	338	return 0;
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	339
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	340	out_release_master:
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	341	EtherCAT_release(ecat_master);
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	342
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	343	out_msr_cleanup:
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	344	msr_rtlib_cleanup();
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	345
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	346	out_return:
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	347	return -1;
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	348	}
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	349
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	350	/*****************************************************************************/
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	351
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	352	void __exit cleanup_module()
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	353	{
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	354	unsigned int i;
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	355
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	356	msr_print_info("msk_modul: unloading...");
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	357
45 f525f7db2d90 Verbesserte Makefiles (MODPOST-Warnungen entfernt). Florian Pose <fp@igh-essen.com> parents: 43 diff changeset	358	ipipe_tune_timer(1000000000UL / HZ, 0); //alten Timertakt wieder herstellen
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	359	ipipe_unregister_domain(&this_domain);
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	360
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	361	if (ecat_master)
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	362	{
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	363	printk(KERN_INFO "=== Stopping EtherCAT environment... ===\n");
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	364
36 6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	365	printk(KERN_INFO "Deactivating slaves.\n");
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	366
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	367	for (i = 0; i < ECAT_SLAVES_COUNT; i++) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	368	if (EtherCAT_deactivate_slave(ecat_master, ecat_slaves + i) < 0) {
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	369	printk(KERN_WARNING "Warning - Could not deactivate slave!\n");
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	370	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	371	}
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	372
36 6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	373	EtherCAT_release(ecat_master);
43 35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	374
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	375	printk(KERN_INFO "=== EtherCAT environment stopped. ===\n");
35120a61d55e Sch?nheitskorrekturen. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	376	}
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	377
36 6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	378	#ifdef USE_MSR_LIB
6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	379	msr_rtlib_cleanup();
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	380	#endif
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	381	}
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	382
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	383	/*****************************************************************************/
a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	384
28 801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	385	MODULE_LICENSE("GPL");
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	386	MODULE_AUTHOR ("Wilhelm Hagemeister <hm@igh-essen.com>");
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	387	MODULE_DESCRIPTION ("EtherCAT test environment");
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	388
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	389	module_init(init_module);
801dc7eabf51 IPIPE,floatpoint,rtlib Wilhelm Hagemeister <hm@igh-essen.com> parents: diff changeset	390	module_exit(cleanup_module);
36 6e9de6fbf74c EtherCAT_release() im Fehlerfall beim Laden von Modulen mini und rt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	391
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 40 diff changeset	392	/*****************************************************************************/

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