etherlabmaster: drivers/ec_module.c@f4171b8aadf8 (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	*
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	3	* ec_module.c
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	*
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	19	******************************************************************************/
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
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	25	#include "ec_module.h"
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	26
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	27	/******************************************************************************/
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	28
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	29	#define SUBVERSION_ID "$Id$"
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	30
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	31	int ecat_master_count = 1;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	32	EtherCAT_master_t *ecat_masters = NULL;
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	33	int *ecat_masters_reserved = NULL;
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	34
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	35	/******************************************************************************/
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	36
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	37	MODULE_AUTHOR ("Wilhelm Hagemeister <hm@igh-essen.com>, Florian Pose <fp@igh-essen.com>");
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	38	MODULE_DESCRIPTION ("EtherCAT master driver module");
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	39	MODULE_LICENSE("GPL");
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	40	MODULE_VERSION(SUBVERSION_ID);
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	41
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	42	module_param(ecat_master_count, int, 1);
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	43	MODULE_PARM_DESC(ecat_master_count, "Number of EtherCAT master to initialize.");
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	44
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	45	module_init(ecat_init_module);
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	46	module_exit(ecat_cleanup_module);
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	47
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	48	EXPORT_SYMBOL(EtherCAT_register_device);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	49	EXPORT_SYMBOL(EtherCAT_unregister_device);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	50	EXPORT_SYMBOL(EtherCAT_request);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	51	EXPORT_SYMBOL(EtherCAT_release);
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	52
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	53	/******************************************************************************/
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	54
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	55	/**
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	56	Init-Funktion des EtherCAT-Master-Treibermodules
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	57
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	58	Initialisiert soviele Master, wie im Parameter ecat_master_count
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	59	angegeben wurde (Default ist 1).
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	@returns 0, wenn alles o.k., -1 bei ungueltiger Anzahl Master
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	62	oder zu wenig Speicher.
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	63	*/
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	64
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	65	int __init ecat_init_module(void)
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	66	{
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	67	unsigned int i;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	68
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	69	printk(KERN_ERR "EtherCAT: Master driver %s\n", SUBVERSION_ID);
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	70
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	71	if (ecat_master_count < 1)
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	72	{
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	73	printk(KERN_ERR "EtherCAT: Error - Illegal ecat_master_count: %i\n",
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	74	ecat_master_count);
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	75	return -1;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	76	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	77
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	78	printk(KERN_ERR "EtherCAT: Initializing %i EtherCAT master(s)...\n",
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	79	ecat_master_count);
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	80
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	81	if ((ecat_masters = (EtherCAT_master_t *) kmalloc(sizeof(EtherCAT_master_t)
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	82	* ecat_master_count,
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	83	GFP_KERNEL)) == NULL)
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	84	{
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	85	printk(KERN_ERR "EtherCAT: Could not allocate memory for EtherCAT master(s)!\n");
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	86	return -1;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	87	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	88
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	89	if ((ecat_masters_reserved = (int ) kmalloc(sizeof(int) ecat_master_count,
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	90	GFP_KERNEL)) == NULL)
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	91	{
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	92	printk(KERN_ERR "EtherCAT: Could not allocate memory for reservation flags!\n");
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	93	kfree(ecat_masters);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	94	return -1;
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	95	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	96
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	97	for (i = 0; i < ecat_master_count; i++)
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	98	{
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	99	EtherCAT_master_init(&ecat_masters[i]);
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	100	ecat_masters_reserved[i] = 0;
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	101	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	102
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	103	printk(KERN_ERR "EtherCAT: Master driver initialized.\n");
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	104
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	105	return 0;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	106	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	107
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	/**
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	111	Cleanup-Funktion des EtherCAT-Master-Treibermoduls
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	112
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	113	Entfernt alle Master-Instanzen.
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	114	*/
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	115
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	116	void __exit ecat_cleanup_module(void)
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	117	{
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	118	unsigned int i;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	119
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	120	printk(KERN_ERR "EtherCAT: Cleaning up master driver...\n");
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	121
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	122	if (ecat_masters)
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	123	{
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	124	for (i = 0; i < ecat_master_count; i++)
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	125	{
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	126	if (ecat_masters_reserved[i]) {
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	127	printk(KERN_WARNING "EtherCAT: Warning - Master %i is still in use!\n", i);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	128	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	129
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	130	EtherCAT_master_clear(&ecat_masters[i]);
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	131	}
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	kfree(ecat_masters);
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	134	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	135
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	136	printk(KERN_ERR "EtherCAT: Master driver cleaned up.\n");
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	137	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: 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
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	141	/**
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	142	Setzt das EtherCAT-Geraet, auf dem der Master arbeitet.
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	143
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	144	Registriert das Geraet beim Master, der es daraufhin oeffnet.
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	145
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	146	@param master Der EtherCAT-Master
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	147	@param device Das EtherCAT-Geraet
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.,
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	149	< 0, wenn bereits ein Geraet registriert
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	150	oder das Geraet nicht geoeffnet werden konnte.
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	151	*/
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	152
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	153	int EtherCAT_register_device(int index, EtherCAT_device_t *device)
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	154	{
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	155	if (index < 0 \|\| index >= ecat_master_count)
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	156	{
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	157	printk(KERN_ERR "EtherCAT: Master %i does not exist!\n", index);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	158	return -1;
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	159	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	160
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	161	return EtherCAT_master_open(&ecat_masters[index], device);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	162	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	163
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	164	/***************************************************************/
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	165
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	166	/**
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	167	Loescht das EtherCAT-Geraet, auf dem der Master arbeitet.
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	168
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	169	@param master Der EtherCAT-Master
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	170	@param device Das EtherCAT-Geraet
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	171	*/
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	172
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	173	void EtherCAT_unregister_device(int index, EtherCAT_device_t *device)
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	174	{
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	175	if (index < 0 \|\| index >= ecat_master_count)
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	176	{
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	177	printk(KERN_WARNING "EtherCAT: Master %i does not exist!\n", index);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	178	return;
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	179	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	180
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	181	EtherCAT_master_close(&ecat_masters[index], device);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	182	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	183
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	184	/******************************************************************************/
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	185
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	186	/**
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	187	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	188
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	189	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	190
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	191	@param index Index des gewuenschten Masters
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	192	@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	193	*/
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	194
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	195	EtherCAT_master_t *EtherCAT_request(int index)
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	196	{
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	197	if (index < 0 \|\| index >= ecat_master_count) {
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	198	printk(KERN_ERR "EtherCAT: Master %i does not exist!\n", index);
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	199	return NULL;
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	200	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	201
33 f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	202	if (ecat_masters_reserved[index]) {
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	203	printk(KERN_ERR "EtherCAT: Master %i already in use!\n", index);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	204	return NULL;
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	205	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	206
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	207	if (!ecat_masters[index].dev) {
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	208	printk(KERN_ERR "EtherCAT: Master %i has no device assigned yet!\n", index);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	209	return NULL;
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	210	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	211
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	212	if (!ecat_masters[index].dev->module) {
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	213	printk(KERN_ERR "EtherCAT: Master %i device module is not set!\n", index);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	214	return NULL;
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	215	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	216
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	217	if (!try_module_get(ecat_masters[index].dev->module)) {
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	218	printk(KERN_ERR "EtherCAT: Could not reserve device module!\n");
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	219	return NULL;
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	220	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	221
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	222	ecat_masters_reserved[index] = 1;
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	223
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	224	printk(KERN_INFO "EtherCAT: Reserved master %i.\n", index);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	225
27 d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	226	return &ecat_masters[index];
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	227	}
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	228
d75ef6b46e33 EtherCAT-Master in eigenes Modul ausgelagert. Florian Pose <fp@igh-essen.com> parents: diff changeset	229	/******************************************************************************/
33 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	/**
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	232	Gibt einen zuvor reservierten EtherCAT-Master wieder frei.
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	233
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	234	@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	235	*/
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	236
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	237	void EtherCAT_release(EtherCAT_master_t *master)
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	238	{
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	239	unsigned int i;
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	240
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	241	for (i = 0; i < ecat_master_count; i++)
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	242	{
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	243	if (&ecat_masters[i] == master)
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	244	{
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	245	if (!ecat_masters[i].dev) {
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	246	printk(KERN_WARNING "EtherCAT: Could not release device"
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	247	"module because of no device!\n");
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	248	return;
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	249	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	250
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	251	module_put(ecat_masters[i].dev->module);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	252	ecat_masters_reserved[i] = 0;
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	253
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	254	printk(KERN_INFO "EtherCAT: Released master %i.\n", i);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	255
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	256	return;
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	257	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	258	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	259
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	260	printk(KERN_WARNING "EtherCAT: Master %X was never reserved!\n",
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	261	(unsigned int) master);
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	262	}
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	263
f4171b8aadf8 Master-Reservierung und Use-Count f?r NIC-Treiber. Florian Pose <fp@igh-essen.com> parents: 27 diff changeset	264	/******************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Fri, 16 Dec 2005 12:04:59 +0000
branch	kernel2.6
changeset 33	f4171b8aadf8
parent 27	d75ef6b46e33
child 34	c1e8d61fa395
permissions	-rw-r--r--