etherlabmaster: master/module.c@98335157e54e (annotated)

27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	1	/******************************************************************************
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	2	*
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	3	* m o d u l e . c
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	4	*
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	5	* EtherCAT-Master-Treiber
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	6	*
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	7	* Autoren: Wilhelm Hagemeister, Florian Pose
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	8	*
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	9	* $Id$
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	10	*
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	11	* (C) Copyright IgH 2005
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	12	* Ingenieurgemeinschaft IgH
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	13	* Heinz-Bäcker Str. 34
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	14	* D-45356 Essen
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	15	* Tel.: +49 201/61 99 31
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	16	* Fax.: +49 201/61 98 36
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	17	* E-mail: sp@igh-essen.com
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	18	*
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 34 diff changeset	19	*****************************************************************************/
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	20
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	21	#include <linux/module.h>
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	22	#include <linux/kernel.h>
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	23	#include <linux/init.h>
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	24
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	25	#include "master.h"
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	26	#include "device.h"
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	27
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	28	/*****************************************************************************/
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	29
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	30	int __init ec_init_module(void);
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	31	void __exit ec_cleanup_module(void);
52 c0405659a74a Neues Interface. Florian Pose <fp@igh-essen.com> parents: 42 diff changeset	32
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 34 diff changeset	33	/*****************************************************************************/
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 34 diff changeset	34
79 319a97c1f0f9 Compile-Warnings mit ADEOS behoben. Florian Pose <fp@igh-essen.com> parents: 78 diff changeset	35	#define EC_LIT(X) #X
319a97c1f0f9 Compile-Warnings mit ADEOS behoben. Florian Pose <fp@igh-essen.com> parents: 78 diff changeset	36	#define EC_STR(X) EC_LIT(X)
319a97c1f0f9 Compile-Warnings mit ADEOS behoben. Florian Pose <fp@igh-essen.com> parents: 78 diff changeset	37
319a97c1f0f9 Compile-Warnings mit ADEOS behoben. Florian Pose <fp@igh-essen.com> parents: 78 diff changeset	38	#define COMPILE_INFO "Revision " EC_STR(EC_REV) \
319a97c1f0f9 Compile-Warnings mit ADEOS behoben. Florian Pose <fp@igh-essen.com> parents: 78 diff changeset	39	", compiled by " EC_STR(EC_USER) \
319a97c1f0f9 Compile-Warnings mit ADEOS behoben. Florian Pose <fp@igh-essen.com> parents: 78 diff changeset	40	" at " EC_STR(EC_DATE)
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 34 diff changeset	41
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 34 diff changeset	42	/*****************************************************************************/
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	43
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	44	int ec_master_count = 1;
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	45	ec_master_t *ec_masters = NULL;
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	46	int *ec_masters_reserved = NULL;
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	47
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 34 diff changeset	48	/*****************************************************************************/
6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 34 diff changeset	49
64 ea6ccf12c612 CANopen over EtherCAT. Florian Pose <fp@igh-essen.com> parents: 58 diff changeset	50	MODULE_AUTHOR ("Florian Pose <fp@igh-essen.com>");
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	51	MODULE_DESCRIPTION ("EtherCAT master driver module");
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	52	MODULE_LICENSE("GPL");
34 c1e8d61fa395 Compile-Informationen hinzugef?gt. Florian Pose <fp@igh-essen.com> parents: 33 diff changeset	53	MODULE_VERSION(COMPILE_INFO);
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	54
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	55	module_param(ec_master_count, int, 1);
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	56	MODULE_PARM_DESC(ec_master_count, "Number of EtherCAT master to initialize.");
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	57
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 34 diff changeset	58	/*****************************************************************************/
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	59
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	60	/**
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	61	Init-Funktion des EtherCAT-Master-Treibermodules
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	62
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	63	Initialisiert soviele Master, wie im Parameter ec_master_count
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	64	angegeben wurde (Default ist 1).
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	65
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	66	@returns 0, wenn alles o.k., -1 bei ungueltiger Anzahl Master
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	67	oder zu wenig Speicher.
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	68	*/
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	69
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	70	int __init ec_init_module(void)
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	71	{
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	72	unsigned int i;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	73
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	74	EC_INFO("Master driver, %s\n", COMPILE_INFO);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	75
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	76	if (ec_master_count < 1) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	77	EC_ERR("Error - Illegal ec_master_count: %i\n", ec_master_count);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	78	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	79	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	80
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	81	EC_INFO("Initializing %i EtherCAT master(s)...\n", ec_master_count);
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	82
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	83	if ((ec_masters = (ec_master_t *) kmalloc(sizeof(ec_master_t)
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	84	* ec_master_count,
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	85	GFP_KERNEL)) == NULL) {
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	86	EC_ERR("Could not allocate memory for EtherCAT master(s)!\n");
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	87	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	88	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	89
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	90	if ((ec_masters_reserved =
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	91	(int ) kmalloc(sizeof(int) ec_master_count, GFP_KERNEL)) == NULL) {
b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	92	EC_ERR("Could not allocate memory for reservation flags!\n");
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	93	kfree(ec_masters);
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	94	return -1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	95	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	96
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	97	for (i = 0; i < ec_master_count; i++) {
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	98	ec_master_init(ec_masters + i);
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	99	ec_masters_reserved[i] = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	100	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	101
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	102	EC_INFO("Master driver initialized.\n");
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	103
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	104	return 0;
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	105	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	106
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 34 diff changeset	107	/*****************************************************************************/
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	108
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	109	/**
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	110	Cleanup-Funktion des EtherCAT-Master-Treibermoduls
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	111
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	112	Entfernt alle Master-Instanzen.
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	113	*/
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	114
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	115	void __exit ec_cleanup_module(void)
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	116	{
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	117	unsigned int i;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	118
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	119	EC_INFO("Cleaning up master driver...\n");
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	120
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	121	if (ec_masters) {
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	122	for (i = 0; i < ec_master_count; i++) {
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	123	if (ec_masters_reserved[i]) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	124	EC_WARN("Master %i is still in use!\n", i);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	125	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	126	ec_master_clear(&ec_masters[i]);
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	127	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	128	kfree(ec_masters);
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	129	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	130
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	131	EC_INFO("Master driver cleaned up.\n");
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	132	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	133
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	134	/******************************************************************************
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	135	*
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	136	* Treiberschnittstelle
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	137	*
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	138	*****************************************************************************/
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	139
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	140	/**
58 21b7342e2a90 Code-Dokumentation mit Doxygen aufgearbeitet. Florian Pose <fp@igh-essen.com> parents: 56 diff changeset	141	Registeriert das EtherCAT-Geraet fuer einen EtherCAT-Master.
21b7342e2a90 Code-Dokumentation mit Doxygen aufgearbeitet. Florian Pose <fp@igh-essen.com> parents: 56 diff changeset	142
21b7342e2a90 Code-Dokumentation mit Doxygen aufgearbeitet. Florian Pose <fp@igh-essen.com> parents: 56 diff changeset	143	@param master_index Index des EtherCAT-Masters
21b7342e2a90 Code-Dokumentation mit Doxygen aufgearbeitet. Florian Pose <fp@igh-essen.com> parents: 56 diff changeset	144	@param dev Das net_device des EtherCAT-Geraetes
21b7342e2a90 Code-Dokumentation mit Doxygen aufgearbeitet. Florian Pose <fp@igh-essen.com> parents: 56 diff changeset	145	@param isr Funktionszeiger auf die Interrupt-Service-Routine
21b7342e2a90 Code-Dokumentation mit Doxygen aufgearbeitet. Florian Pose <fp@igh-essen.com> parents: 56 diff changeset	146	@param module Zeiger auf das Modul (fuer try_module_lock())
21b7342e2a90 Code-Dokumentation mit Doxygen aufgearbeitet. Florian Pose <fp@igh-essen.com> parents: 56 diff changeset	147
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	148	@return 0, wenn alles o.k.,
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	149	< 0, wenn bereits ein Geraet registriert oder das Geraet nicht
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	150	geoeffnet werden konnte.
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	151	*/
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	152
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	153	ec_device_t *EtherCAT_dev_register(unsigned int master_index,
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	154	struct net_device *dev,
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	155	irqreturn_t (isr)(int, void ,
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	156	struct pt_regs *),
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	157	struct module *module)
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	158	{
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	159	ec_device_t *ecd;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	160	ec_master_t *master;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	161
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	162	if (master_index >= ec_master_count) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	163	EC_ERR("Master %i does not exist!\n", master_index);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	164	return NULL;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	165	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	166
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	167	if (!dev) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	168	EC_WARN("Device is NULL!\n");
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	169	return NULL;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	170	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	171
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	172	master = ec_masters + master_index;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	173
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	174	if (master->device_registered) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	175	EC_ERR("Master %i already has a device!\n", master_index);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	176	return NULL;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	177	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	178
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	179	ecd = &master->device;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	180
78 3d74183d6c6b Frame-Debugging ins Device ausgelagert und verbessert. Florian Pose <fp@igh-essen.com> parents: 73 diff changeset	181	if (ec_device_init(ecd, master) < 0) return NULL;
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	182
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	183	ecd->dev = dev;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	184	ecd->tx_skb->dev = dev;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	185	ecd->isr = isr;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	186	ecd->module = module;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	187
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	188	master->device_registered = 1;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	189
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	190	return ecd;
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	191	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	192
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 34 diff changeset	193	/*****************************************************************************/
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	194
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	195	/**
58 21b7342e2a90 Code-Dokumentation mit Doxygen aufgearbeitet. Florian Pose <fp@igh-essen.com> parents: 56 diff changeset	196	Entfernt das EtherCAT-Geraet eines EtherCAT-Masters.
21b7342e2a90 Code-Dokumentation mit Doxygen aufgearbeitet. Florian Pose <fp@igh-essen.com> parents: 56 diff changeset	197
21b7342e2a90 Code-Dokumentation mit Doxygen aufgearbeitet. Florian Pose <fp@igh-essen.com> parents: 56 diff changeset	198	@param master_index Der Index des EtherCAT-Masters
21b7342e2a90 Code-Dokumentation mit Doxygen aufgearbeitet. Florian Pose <fp@igh-essen.com> parents: 56 diff changeset	199	@param ecd Das EtherCAT-Geraet
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	200	*/
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	201
55 059a9e712aa7 Mit neuer Schnittstelle wieder lauff?hig. Florian Pose <fp@igh-essen.com> parents: 54 diff changeset	202	void EtherCAT_dev_unregister(unsigned int master_index, ec_device_t *ecd)
059a9e712aa7 Mit neuer Schnittstelle wieder lauff?hig. Florian Pose <fp@igh-essen.com> parents: 54 diff changeset	203	{
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	204	ec_master_t *master;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	205
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	206	if (master_index >= ec_master_count) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	207	EC_WARN("Master %i does not exist!\n", master_index);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	208	return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	209	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	210
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	211	master = ec_masters + master_index;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	212
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	213	if (!master->device_registered \|\| &master->device != ecd) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	214	EC_WARN("Unable to unregister device!\n");
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	215	return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	216	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	217
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	218	master->device_registered = 0;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	219	ec_device_clear(ecd);
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	220	}
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	221
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	222	/******************************************************************************
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	223	*
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	224	* Echtzeitschnittstelle
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	225	*
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	226	*****************************************************************************/
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	227
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	228	/**
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	229	Reserviert einen bestimmten EtherCAT-Master und das zugehörige Gerät.
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	230
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	231	Gibt einen Zeiger auf den reservierten EtherCAT-Master zurueck.
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	232
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	233	@param index Index des gewuenschten Masters
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	234	@returns Zeiger auf EtherCAT-Master oder NULL, wenn Parameter ungueltig.
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	235	*/
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	236
55 059a9e712aa7 Mit neuer Schnittstelle wieder lauff?hig. Florian Pose <fp@igh-essen.com> parents: 54 diff changeset	237	ec_master_t *EtherCAT_rt_request_master(unsigned int index)
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	238	{
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	239	ec_master_t *master;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	240
88 98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	241	EC_INFO("===== Starting master %i... =====\n", index);
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	242
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	243	if (index < 0 \|\| index >= ec_master_count) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	244	EC_ERR("Master %i does not exist!\n", index);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	245	goto req_return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	246	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	247
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	248	if (ec_masters_reserved[index]) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	249	EC_ERR("Master %i already in use!\n", index);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	250	goto req_return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	251	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	252
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	253	master = &ec_masters[index];
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	254
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	255	if (!master->device_registered) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	256	EC_ERR("Master %i has no device assigned yet!\n", index);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	257	goto req_return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	258	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	259
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	260	if (!try_module_get(master->device.module)) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	261	EC_ERR("Failed to reserve device module!\n");
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	262	goto req_return;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	263	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	264
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	265	if (ec_master_open(master) < 0) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	266	EC_ERR("Failed to open device!\n");
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	267	goto req_module_put;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	268	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	269
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	270	if (ec_scan_for_slaves(master) != 0) {
84 b4ae98855cea printk durch Makros ersetzt. Florian Pose <fp@igh-essen.com> parents: 79 diff changeset	271	EC_ERR("Bus scan failed!\n");
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	272	goto req_close;
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	273	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	274
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	275	ec_masters_reserved[index] = 1;
88 98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	276	EC_INFO("===== Master %i ready. =====\n", index);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	277
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	278	return master;
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	279
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	280	req_close:
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	281	ec_master_close(master);
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	282
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	283	req_module_put:
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	284	module_put(master->device.module);
85 eb24637883ef Master wird nach nicht erfolgreichem Request resettet. Florian Pose <fp@igh-essen.com> parents: 84 diff changeset	285	ec_master_reset(master);
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	286
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	287	req_return:
88 98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	288	EC_INFO("===== Failed to start master %i =====\n", index);
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	289	return NULL;
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	290	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	291
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 34 diff changeset	292	/*****************************************************************************/
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	293
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	294	/**
42 a22a202d0f42 Domains, Warten beim Senden, 10kHz. Florian Pose <fp@igh-essen.com> parents: 39 diff changeset	295	Gibt einen zuvor angeforderten EtherCAT-Master wieder frei.
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	296
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	297	@param master Zeiger auf den freizugebenden EtherCAT-Master.
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	298	*/
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	299
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	300	void EtherCAT_rt_release_master(ec_master_t *master)
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	301	{
88 98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	302	unsigned int i, found;
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	303
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	304	found = 0;
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	305	for (i = 0; i < ec_master_count; i++) {
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	306	if (&ec_masters[i] == master) {
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	307	found = 1;
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	308	break;
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	309	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	310	}
9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	311
88 98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	312	if (!found) {
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	313	EC_WARN("Master %X was never requested!\n", (u32) master);
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	314	return;
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	315	}
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	316
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	317	EC_INFO("===== Stopping master %i... =====\n", i);
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	318
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	319	ec_master_close(master);
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	320	ec_master_reset(master);
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	321
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	322	module_put(master->device.module);
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	323	ec_masters_reserved[i] = 0;
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	324
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	325	EC_INFO("===== Master %i stopped. =====\n", i);
98335157e54e Bessere Ausgaben beim Starten und beenden. Florian Pose <fp@igh-essen.com> parents: 85 diff changeset	326	return;
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	327	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	328
39 6965c23a6826 likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert. Florian Pose <fp@igh-essen.com> parents: 34 diff changeset	329	/*****************************************************************************/
54 7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	330
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	331	module_init(ec_init_module);
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	332	module_exit(ec_cleanup_module);
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	333
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	334	EXPORT_SYMBOL(EtherCAT_dev_register);
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	335	EXPORT_SYMBOL(EtherCAT_dev_unregister);
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	336	EXPORT_SYMBOL(EtherCAT_rt_request_master);
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	337	EXPORT_SYMBOL(EtherCAT_rt_release_master);
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	338
7506e67dd122 Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt. Florian Pose <fp@igh-essen.com> parents: 52 diff changeset	339	/*****************************************************************************/
55 059a9e712aa7 Mit neuer Schnittstelle wieder lauff?hig. Florian Pose <fp@igh-essen.com> parents: 54 diff changeset	340
059a9e712aa7 Mit neuer Schnittstelle wieder lauff?hig. Florian Pose <fp@igh-essen.com> parents: 54 diff changeset	341	/* Emacs-Konfiguration
059a9e712aa7 Mit neuer Schnittstelle wieder lauff?hig. Florian Pose <fp@igh-essen.com> parents: 54 diff changeset	342	;;; Local Variables: ***
73 9f4ea66d89a3 Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst. Florian Pose <fp@igh-essen.com> parents: 64 diff changeset	343	;;; c-basic-offset:4 ***
55 059a9e712aa7 Mit neuer Schnittstelle wieder lauff?hig. Florian Pose <fp@igh-essen.com> parents: 54 diff changeset	344	;;; End: ***
059a9e712aa7 Mit neuer Schnittstelle wieder lauff?hig. Florian Pose <fp@igh-essen.com> parents: 54 diff changeset	345	*/

author	Florian Pose <fp@igh-essen.com>
	Sun, 26 Feb 2006 12:26:23 +0000
changeset 88	98335157e54e
parent 85	eb24637883ef
child 91	0120d6214948
permissions	-rw-r--r--