author | Martin Troxler <martin.troxler@komaxgroup.com> |
Tue, 02 Feb 2010 08:35:28 +0100 | |
changeset 1802 | 8876c3d9357d |
parent 1586 | eb9185dfa8ac |
child 1814 | 23fcca9ef1fb |
permissions | -rw-r--r-- |
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 |
* $Id$ |
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
4 |
* |
1326
ef907b0b5125
merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents:
1313
diff
changeset
|
5 |
* Copyright (C) 2006-2008 Florian Pose, Ingenieurgemeinschaft IgH |
197
b9a6e2c22745
GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents:
196
diff
changeset
|
6 |
* |
b9a6e2c22745
GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents:
196
diff
changeset
|
7 |
* This file is part of the IgH EtherCAT Master. |
b9a6e2c22745
GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents:
196
diff
changeset
|
8 |
* |
1326
ef907b0b5125
merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents:
1313
diff
changeset
|
9 |
* The IgH EtherCAT Master is free software; you can redistribute it and/or |
ef907b0b5125
merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents:
1313
diff
changeset
|
10 |
* modify it under the terms of the GNU General Public License version 2, as |
ef907b0b5125
merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents:
1313
diff
changeset
|
11 |
* published by the Free Software Foundation. |
ef907b0b5125
merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents:
1313
diff
changeset
|
12 |
* |
ef907b0b5125
merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents:
1313
diff
changeset
|
13 |
* The IgH EtherCAT Master is distributed in the hope that it will be useful, |
ef907b0b5125
merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents:
1313
diff
changeset
|
14 |
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
ef907b0b5125
merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents:
1313
diff
changeset
|
15 |
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General |
ef907b0b5125
merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents:
1313
diff
changeset
|
16 |
* Public License for more details. |
ef907b0b5125
merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents:
1313
diff
changeset
|
17 |
* |
ef907b0b5125
merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents:
1313
diff
changeset
|
18 |
* You should have received a copy of the GNU General Public License along |
ef907b0b5125
merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents:
1313
diff
changeset
|
19 |
* with the IgH EtherCAT Master; if not, write to the Free Software |
197
b9a6e2c22745
GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents:
196
diff
changeset
|
20 |
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
27
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
21 |
* |
1363
11c0b2caa253
Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents:
1337
diff
changeset
|
22 |
* --- |
11c0b2caa253
Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents:
1337
diff
changeset
|
23 |
* |
11c0b2caa253
Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents:
1337
diff
changeset
|
24 |
* The license mentioned above concerns the source code only. Using the |
11c0b2caa253
Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents:
1337
diff
changeset
|
25 |
* EtherCAT technology and brand is only permitted in compliance with the |
11c0b2caa253
Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents:
1337
diff
changeset
|
26 |
* industrial property and similar rights of Beckhoff Automation GmbH. |
246
0bf7c769de06
Changed license headers and added EtherCAT license notice.
Florian Pose <fp@igh-essen.com>
parents:
201
diff
changeset
|
27 |
* |
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
34
diff
changeset
|
28 |
*****************************************************************************/ |
27
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
29 |
|
792
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
758
diff
changeset
|
30 |
/** \file |
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
758
diff
changeset
|
31 |
* EtherCAT master driver module. |
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
758
diff
changeset
|
32 |
*/ |
199
04ecf40fc2e9
Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents:
197
diff
changeset
|
33 |
|
04ecf40fc2e9
Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents:
197
diff
changeset
|
34 |
/*****************************************************************************/ |
04ecf40fc2e9
Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents:
197
diff
changeset
|
35 |
|
27
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
36 |
#include <linux/module.h> |
1014
d39d430cfdc4
Replaced include sysfs->device.
Florian Pose <fp@igh-essen.com>
parents:
1013
diff
changeset
|
37 |
#include <linux/device.h> |
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1209
diff
changeset
|
38 |
#include <linux/err.h> |
27
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
39 |
|
184
2fc86cec12df
Macro for SysFS attribute definition
Florian Pose <fp@igh-essen.com>
parents:
178
diff
changeset
|
40 |
#include "globals.h" |
54
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
41 |
#include "master.h" |
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
42 |
#include "device.h" |
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
43 |
|
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
44 |
/*****************************************************************************/ |
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
45 |
|
792
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
758
diff
changeset
|
46 |
#define MAX_MASTERS 5 /**< Maximum number of masters. */ |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
47 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
48 |
/*****************************************************************************/ |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
49 |
|
54
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
50 |
int __init ec_init_module(void); |
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
51 |
void __exit ec_cleanup_module(void); |
52 | 52 |
|
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
53 |
static int ec_mac_parse(uint8_t *, const char *, int); |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
54 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
55 |
/*****************************************************************************/ |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
56 |
|
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
57 |
static char *main_devices[MAX_MASTERS]; /**< Main devices parameter. */ |
1399
f79d4bb5b23a
Added debug_level module parameter. debug_level is now unsigned int.
Florian Pose <fp@igh-essen.com>
parents:
1363
diff
changeset
|
58 |
static unsigned int master_count; /**< Number of masters. */ |
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
59 |
static char *backup_devices[MAX_MASTERS]; /**< Backup devices parameter. */ |
1399
f79d4bb5b23a
Added debug_level module parameter. debug_level is now unsigned int.
Florian Pose <fp@igh-essen.com>
parents:
1363
diff
changeset
|
60 |
static unsigned int backup_count; /**< Number of backup devices. */ |
f79d4bb5b23a
Added debug_level module parameter. debug_level is now unsigned int.
Florian Pose <fp@igh-essen.com>
parents:
1363
diff
changeset
|
61 |
static unsigned int debug_level; /**< Debug level parameter. */ |
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
62 |
|
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
63 |
static ec_master_t *masters; /**< Array of masters. */ |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
64 |
static struct semaphore master_sem; /**< Master semaphore. */ |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
65 |
|
954
4e7be3b24622
Removed static from device.
Florian Pose <fp@igh-essen.com>
parents:
922
diff
changeset
|
66 |
dev_t device_number; /**< Device number for master cdevs. */ |
1012
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
67 |
struct class *class; /**< Device class. */ |
922
fede1d8f5b71
Added the new ethercat comman-line tool with lsec functionality.
Florian Pose <fp@igh-essen.com>
parents:
919
diff
changeset
|
68 |
|
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
69 |
static uint8_t macs[MAX_MASTERS][2][ETH_ALEN]; /**< MAC addresses. */ |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
70 |
|
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
71 |
char *ec_master_version_str = EC_MASTER_VERSION; /**< Version string. */ |
444
31223539fc00
Compiler flag -DSVNREV only for module.c to avoid unnecessary recompiling.
Florian Pose <fp@igh-essen.com>
parents:
430
diff
changeset
|
72 |
|
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
34
diff
changeset
|
73 |
/*****************************************************************************/ |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
34
diff
changeset
|
74 |
|
199
04ecf40fc2e9
Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents:
197
diff
changeset
|
75 |
/** \cond */ |
04ecf40fc2e9
Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents:
197
diff
changeset
|
76 |
|
251
c1d0b63a9302
EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents:
249
diff
changeset
|
77 |
MODULE_AUTHOR("Florian Pose <fp@igh-essen.com>"); |
c1d0b63a9302
EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents:
249
diff
changeset
|
78 |
MODULE_DESCRIPTION("EtherCAT master driver module"); |
27
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
79 |
MODULE_LICENSE("GPL"); |
382
72500991bcc3
Altered master version string.
Florian Pose <fp@igh-essen.com>
parents:
381
diff
changeset
|
80 |
MODULE_VERSION(EC_MASTER_VERSION); |
573
cdee4ea90ce9
Introduced device IDs; removed comment lines from 8139too; removed
Florian Pose <fp@igh-essen.com>
parents:
572
diff
changeset
|
81 |
|
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
82 |
module_param_array(main_devices, charp, &master_count, S_IRUGO); |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
83 |
MODULE_PARM_DESC(main_devices, "MAC addresses of main devices"); |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
84 |
module_param_array(backup_devices, charp, &backup_count, S_IRUGO); |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
85 |
MODULE_PARM_DESC(backup_devices, "MAC addresses of backup devices"); |
1399
f79d4bb5b23a
Added debug_level module parameter. debug_level is now unsigned int.
Florian Pose <fp@igh-essen.com>
parents:
1363
diff
changeset
|
86 |
module_param_named(debug_level, debug_level, uint, S_IRUGO); |
f79d4bb5b23a
Added debug_level module parameter. debug_level is now unsigned int.
Florian Pose <fp@igh-essen.com>
parents:
1363
diff
changeset
|
87 |
MODULE_PARM_DESC(debug_level, "Debug level"); |
195
674071846ee3
Translated all comments and documentation to english language.
Florian Pose <fp@igh-essen.com>
parents:
191
diff
changeset
|
88 |
|
199
04ecf40fc2e9
Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents:
197
diff
changeset
|
89 |
/** \endcond */ |
04ecf40fc2e9
Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents:
197
diff
changeset
|
90 |
|
195
674071846ee3
Translated all comments and documentation to english language.
Florian Pose <fp@igh-essen.com>
parents:
191
diff
changeset
|
91 |
/*****************************************************************************/ |
674071846ee3
Translated all comments and documentation to english language.
Florian Pose <fp@igh-essen.com>
parents:
191
diff
changeset
|
92 |
|
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
93 |
/** Module initialization. |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
94 |
* |
922
fede1d8f5b71
Added the new ethercat comman-line tool with lsec functionality.
Florian Pose <fp@igh-essen.com>
parents:
919
diff
changeset
|
95 |
* Initializes \a master_count masters. |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
96 |
* \return 0 on success, else < 0 |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
97 |
*/ |
54
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
98 |
int __init ec_init_module(void) |
27
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
99 |
{ |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
100 |
int i, ret = 0; |
73
9f4ea66d89a3
Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst.
Florian Pose <fp@igh-essen.com>
parents:
64
diff
changeset
|
101 |
|
382
72500991bcc3
Altered master version string.
Florian Pose <fp@igh-essen.com>
parents:
381
diff
changeset
|
102 |
EC_INFO("Master driver %s\n", EC_MASTER_VERSION); |
73
9f4ea66d89a3
Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst.
Florian Pose <fp@igh-essen.com>
parents:
64
diff
changeset
|
103 |
|
1579
326d47aa986c
applied komax patch to version r1822
Martin Troxler <martin.troxler@komaxgroup.com>
parents:
1469
diff
changeset
|
104 |
sema_init(&master_sem, 1); |
653
33aa0e7e5a68
Fixed missing semaphore initialization.
Florian Pose <fp@igh-essen.com>
parents:
648
diff
changeset
|
105 |
|
997
652180478e95
Removed kobject from master and module. Sysfs is gone!
Florian Pose <fp@igh-essen.com>
parents:
954
diff
changeset
|
106 |
if (master_count) { |
652180478e95
Removed kobject from master and module. Sysfs is gone!
Florian Pose <fp@igh-essen.com>
parents:
954
diff
changeset
|
107 |
if (alloc_chrdev_region(&device_number, 0, master_count, "EtherCAT")) { |
652180478e95
Removed kobject from master and module. Sysfs is gone!
Florian Pose <fp@igh-essen.com>
parents:
954
diff
changeset
|
108 |
EC_ERR("Failed to obtain device number(s)!\n"); |
652180478e95
Removed kobject from master and module. Sysfs is gone!
Florian Pose <fp@igh-essen.com>
parents:
954
diff
changeset
|
109 |
ret = -EBUSY; |
652180478e95
Removed kobject from master and module. Sysfs is gone!
Florian Pose <fp@igh-essen.com>
parents:
954
diff
changeset
|
110 |
goto out_return; |
652180478e95
Removed kobject from master and module. Sysfs is gone!
Florian Pose <fp@igh-essen.com>
parents:
954
diff
changeset
|
111 |
} |
922
fede1d8f5b71
Added the new ethercat comman-line tool with lsec functionality.
Florian Pose <fp@igh-essen.com>
parents:
919
diff
changeset
|
112 |
} |
fede1d8f5b71
Added the new ethercat comman-line tool with lsec functionality.
Florian Pose <fp@igh-essen.com>
parents:
919
diff
changeset
|
113 |
|
1012
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
114 |
class = class_create(THIS_MODULE, "EtherCAT"); |
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
115 |
if (IS_ERR(class)) { |
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
116 |
EC_ERR("Failed to create device class.\n"); |
1313
ed15eef57d5c
Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents:
1312
diff
changeset
|
117 |
ret = PTR_ERR(class); |
1012
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
118 |
goto out_cdev; |
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
119 |
} |
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
120 |
|
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
121 |
// zero MAC addresses |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
122 |
memset(macs, 0x00, sizeof(uint8_t) * MAX_MASTERS * 2 * ETH_ALEN); |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
123 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
124 |
// process MAC parameters |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
125 |
for (i = 0; i < master_count; i++) { |
1313
ed15eef57d5c
Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents:
1312
diff
changeset
|
126 |
ret = ec_mac_parse(macs[i][0], main_devices[i], 0); |
ed15eef57d5c
Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents:
1312
diff
changeset
|
127 |
if (ret) |
1012
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
128 |
goto out_class; |
573
cdee4ea90ce9
Introduced device IDs; removed comment lines from 8139too; removed
Florian Pose <fp@igh-essen.com>
parents:
572
diff
changeset
|
129 |
|
1313
ed15eef57d5c
Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents:
1312
diff
changeset
|
130 |
if (i < backup_count) { |
ed15eef57d5c
Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents:
1312
diff
changeset
|
131 |
ret = ec_mac_parse(macs[i][1], backup_devices[i], 1); |
ed15eef57d5c
Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents:
1312
diff
changeset
|
132 |
if (ret) |
ed15eef57d5c
Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents:
1312
diff
changeset
|
133 |
goto out_class; |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
134 |
} |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
135 |
} |
1279
6911450535b7
merge -c1522 branches/stable-1.4: Fixed jace in jiffies timeout calculation.
Florian Pose <fp@igh-essen.com>
parents:
1239
diff
changeset
|
136 |
|
6911450535b7
merge -c1522 branches/stable-1.4: Fixed jace in jiffies timeout calculation.
Florian Pose <fp@igh-essen.com>
parents:
1239
diff
changeset
|
137 |
// initialize static master variables |
6911450535b7
merge -c1522 branches/stable-1.4: Fixed jace in jiffies timeout calculation.
Florian Pose <fp@igh-essen.com>
parents:
1239
diff
changeset
|
138 |
ec_master_init_static(); |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
139 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
140 |
if (master_count) { |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
141 |
if (!(masters = kmalloc(sizeof(ec_master_t) * master_count, |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
142 |
GFP_KERNEL))) { |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
143 |
EC_ERR("Failed to allocate memory for EtherCAT masters.\n"); |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
144 |
ret = -ENOMEM; |
1012
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
145 |
goto out_class; |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
146 |
} |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
147 |
} |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
148 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
149 |
for (i = 0; i < master_count; i++) { |
1313
ed15eef57d5c
Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents:
1312
diff
changeset
|
150 |
ret = ec_master_init(&masters[i], i, macs[i][0], macs[i][1], |
1399
f79d4bb5b23a
Added debug_level module parameter. debug_level is now unsigned int.
Florian Pose <fp@igh-essen.com>
parents:
1363
diff
changeset
|
151 |
device_number, class, debug_level); |
1313
ed15eef57d5c
Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents:
1312
diff
changeset
|
152 |
if (ret) |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
153 |
goto out_free_masters; |
573
cdee4ea90ce9
Introduced device IDs; removed comment lines from 8139too; removed
Florian Pose <fp@igh-essen.com>
parents:
572
diff
changeset
|
154 |
} |
cdee4ea90ce9
Introduced device IDs; removed comment lines from 8139too; removed
Florian Pose <fp@igh-essen.com>
parents:
572
diff
changeset
|
155 |
|
cdee4ea90ce9
Introduced device IDs; removed comment lines from 8139too; removed
Florian Pose <fp@igh-essen.com>
parents:
572
diff
changeset
|
156 |
EC_INFO("%u master%s waiting for devices.\n", |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
157 |
master_count, (master_count == 1 ? "" : "s")); |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
158 |
return ret; |
127
e67c80a76de4
Code aufger?umt und kleines Speicherleck entdeckt.
Florian Pose <fp@igh-essen.com>
parents:
111
diff
changeset
|
159 |
|
573
cdee4ea90ce9
Introduced device IDs; removed comment lines from 8139too; removed
Florian Pose <fp@igh-essen.com>
parents:
572
diff
changeset
|
160 |
out_free_masters: |
997
652180478e95
Removed kobject from master and module. Sysfs is gone!
Florian Pose <fp@igh-essen.com>
parents:
954
diff
changeset
|
161 |
for (i--; i >= 0; i--) |
652180478e95
Removed kobject from master and module. Sysfs is gone!
Florian Pose <fp@igh-essen.com>
parents:
954
diff
changeset
|
162 |
ec_master_clear(&masters[i]); |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
163 |
kfree(masters); |
1012
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
164 |
out_class: |
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
165 |
class_destroy(class); |
922
fede1d8f5b71
Added the new ethercat comman-line tool with lsec functionality.
Florian Pose <fp@igh-essen.com>
parents:
919
diff
changeset
|
166 |
out_cdev: |
1012
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
167 |
if (master_count) |
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
168 |
unregister_chrdev_region(device_number, master_count); |
997
652180478e95
Removed kobject from master and module. Sysfs is gone!
Florian Pose <fp@igh-essen.com>
parents:
954
diff
changeset
|
169 |
out_return: |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
170 |
return ret; |
27
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
171 |
} |
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
172 |
|
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
34
diff
changeset
|
173 |
/*****************************************************************************/ |
27
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
174 |
|
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
175 |
/** Module cleanup. |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
176 |
* |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
177 |
* Clears all master instances. |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
178 |
*/ |
54
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
179 |
void __exit ec_cleanup_module(void) |
27
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
180 |
{ |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
181 |
unsigned int i; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
182 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
183 |
for (i = 0; i < master_count; i++) { |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
184 |
ec_master_clear(&masters[i]); |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
185 |
} |
1012
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
186 |
|
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
187 |
if (master_count) |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
188 |
kfree(masters); |
1012
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
189 |
|
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
190 |
class_destroy(class); |
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
191 |
|
89f87a901ce5
Create device class. Preparation for device numbers in sysfs.
Florian Pose <fp@igh-essen.com>
parents:
1011
diff
changeset
|
192 |
if (master_count) |
997
652180478e95
Removed kobject from master and module. Sysfs is gone!
Florian Pose <fp@igh-essen.com>
parents:
954
diff
changeset
|
193 |
unregister_chrdev_region(device_number, master_count); |
652180478e95
Removed kobject from master and module. Sysfs is gone!
Florian Pose <fp@igh-essen.com>
parents:
954
diff
changeset
|
194 |
|
575
9a2121b500b1
Layed out device ID functionality in own files.
Florian Pose <fp@igh-essen.com>
parents:
573
diff
changeset
|
195 |
EC_INFO("Master module cleaned up.\n"); |
27
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
196 |
} |
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
197 |
|
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
198 |
/***************************************************************************** |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
199 |
* MAC address functions |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
200 |
****************************************************************************/ |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
201 |
|
758
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
202 |
/** |
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
203 |
* \return true, if two MAC addresses are equal. |
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
204 |
*/ |
840 | 205 |
int ec_mac_equal( |
206 |
const uint8_t *mac1, /**< First MAC address. */ |
|
207 |
const uint8_t *mac2 /**< Second MAC address. */ |
|
208 |
) |
|
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
209 |
{ |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
210 |
unsigned int i; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
211 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
212 |
for (i = 0; i < ETH_ALEN; i++) |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
213 |
if (mac1[i] != mac2[i]) |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
214 |
return 0; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
215 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
216 |
return 1; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
217 |
} |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
218 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
219 |
/*****************************************************************************/ |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
220 |
|
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
221 |
/** Print a MAC address to a buffer. |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
222 |
* |
758
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
223 |
* \return number of bytes written. |
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
224 |
*/ |
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
225 |
ssize_t ec_mac_print( |
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
226 |
const uint8_t *mac, /**< MAC address */ |
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
227 |
char *buffer /**< target buffer */ |
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
228 |
) |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
229 |
{ |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
230 |
off_t off = 0; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
231 |
unsigned int i; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
232 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
233 |
for (i = 0; i < ETH_ALEN; i++) { |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
234 |
off += sprintf(buffer + off, "%02X", mac[i]); |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
235 |
if (i < ETH_ALEN - 1) off += sprintf(buffer + off, ":"); |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
236 |
} |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
237 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
238 |
return off; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
239 |
} |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
240 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
241 |
/*****************************************************************************/ |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
242 |
|
758
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
243 |
/** |
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
244 |
* \return true, if the MAC address is all-zero. |
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
245 |
*/ |
840 | 246 |
int ec_mac_is_zero( |
247 |
const uint8_t *mac /**< MAC address. */ |
|
248 |
) |
|
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
249 |
{ |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
250 |
unsigned int i; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
251 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
252 |
for (i = 0; i < ETH_ALEN; i++) |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
253 |
if (mac[i]) |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
254 |
return 0; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
255 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
256 |
return 1; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
257 |
} |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
258 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
259 |
/*****************************************************************************/ |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
260 |
|
758
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
261 |
/** |
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
262 |
* \return true, if the given MAC address is the broadcast address. |
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
263 |
*/ |
840 | 264 |
int ec_mac_is_broadcast( |
265 |
const uint8_t *mac /**< MAC address. */ |
|
266 |
) |
|
700
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
267 |
{ |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
268 |
unsigned int i; |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
269 |
|
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
270 |
for (i = 0; i < ETH_ALEN; i++) |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
271 |
if (mac[i] != 0xff) |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
272 |
return 0; |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
273 |
|
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
274 |
return 1; |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
275 |
} |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
276 |
|
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
277 |
/*****************************************************************************/ |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
278 |
|
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
279 |
/** Parse a MAC address from a string. |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
280 |
* |
758
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
281 |
* The MAC address must follow the regexp |
8fa6f825eb7d
Updated Doxygen documentation.
Florian Pose <fp@igh-essen.com>
parents:
700
diff
changeset
|
282 |
* "([0-9a-fA-F]{2}:){5}[0-9a-fA-F]{2}". |
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
283 |
* |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
284 |
* \return 0 on success, else < 0 |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
285 |
*/ |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
286 |
static int ec_mac_parse(uint8_t *mac, const char *src, int allow_empty) |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
287 |
{ |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
288 |
unsigned int i, value; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
289 |
const char *orig = src; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
290 |
char *rem; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
291 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
292 |
if (!strlen(src)) { |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
293 |
if (allow_empty){ |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
294 |
return 0; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
295 |
} |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
296 |
else { |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
297 |
EC_ERR("MAC address may not be empty.\n"); |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
298 |
return -EINVAL; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
299 |
} |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
300 |
} |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
301 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
302 |
for (i = 0; i < ETH_ALEN; i++) { |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
303 |
value = simple_strtoul(src, &rem, 16); |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
304 |
if (rem != src + 2 |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
305 |
|| value > 0xFF |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
306 |
|| (i < ETH_ALEN - 1 && *rem != ':')) { |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
307 |
EC_ERR("Invalid MAC address \"%s\".\n", orig); |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
308 |
return -EINVAL; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
309 |
} |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
310 |
mac[i] = value; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
311 |
if (i < ETH_ALEN - 1) |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
312 |
src = rem + 1; // skip colon |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
313 |
} |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
314 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
315 |
return 0; |
178
b84f69db8566
MERGE branches/sysfs -> trunk (whole SysFS implementation)
Florian Pose <fp@igh-essen.com>
parents:
161
diff
changeset
|
316 |
} |
b84f69db8566
MERGE branches/sysfs -> trunk (whole SysFS implementation)
Florian Pose <fp@igh-essen.com>
parents:
161
diff
changeset
|
317 |
|
196
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
318 |
/*****************************************************************************/ |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
319 |
|
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
320 |
/** Outputs frame contents for debugging purposes. |
1584
cd9a68fd5b89
ec_print_data: show only the first 128 and the last 128 bytes of a data block
Martin Troxler <martin.troxler@komaxgroup.com>
parents:
1583
diff
changeset
|
321 |
* If the data block is larger than 256 bytes, only the first 128 |
cd9a68fd5b89
ec_print_data: show only the first 128 and the last 128 bytes of a data block
Martin Troxler <martin.troxler@komaxgroup.com>
parents:
1583
diff
changeset
|
322 |
* and the last 128 bytes will be shown |
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
323 |
*/ |
196
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
324 |
void ec_print_data(const uint8_t *data, /**< pointer to data */ |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
325 |
size_t size /**< number of bytes to output */ |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
326 |
) |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
327 |
{ |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
328 |
unsigned int i; |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
329 |
|
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
330 |
EC_DBG(""); |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
331 |
for (i = 0; i < size; i++) { |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
332 |
printk("%02X ", data[i]); |
1469
873e4ee3d5ec
Improved newlines in debug data output.
Florian Pose <fp@igh-essen.com>
parents:
1399
diff
changeset
|
333 |
if ((i + 1) % 16 == 0 && i < size - 1) { |
196
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
334 |
printk("\n"); |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
335 |
EC_DBG(""); |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
336 |
} |
1584
cd9a68fd5b89
ec_print_data: show only the first 128 and the last 128 bytes of a data block
Martin Troxler <martin.troxler@komaxgroup.com>
parents:
1583
diff
changeset
|
337 |
if (i+1 == 128 && size > 256) |
1583
017fa8fd9ac1
Each slave got its own SDO state machine (faster handling of external SDO requests)
Martin Troxler <martin.troxler@komaxgroup.com>
parents:
1579
diff
changeset
|
338 |
{ |
1584
cd9a68fd5b89
ec_print_data: show only the first 128 and the last 128 bytes of a data block
Martin Troxler <martin.troxler@komaxgroup.com>
parents:
1583
diff
changeset
|
339 |
printk("dropped %d bytes\n",size-128-i); |
1583
017fa8fd9ac1
Each slave got its own SDO state machine (faster handling of external SDO requests)
Martin Troxler <martin.troxler@komaxgroup.com>
parents:
1579
diff
changeset
|
340 |
i = size - 128; |
1584
cd9a68fd5b89
ec_print_data: show only the first 128 and the last 128 bytes of a data block
Martin Troxler <martin.troxler@komaxgroup.com>
parents:
1583
diff
changeset
|
341 |
EC_DBG(""); |
1583
017fa8fd9ac1
Each slave got its own SDO state machine (faster handling of external SDO requests)
Martin Troxler <martin.troxler@komaxgroup.com>
parents:
1579
diff
changeset
|
342 |
} |
196
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
343 |
} |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
344 |
printk("\n"); |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
345 |
} |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
346 |
|
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
347 |
/*****************************************************************************/ |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
348 |
|
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
349 |
/** Outputs frame contents and differences for debugging purposes. |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
350 |
*/ |
196
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
351 |
void ec_print_data_diff(const uint8_t *d1, /**< first data */ |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
352 |
const uint8_t *d2, /**< second data */ |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
353 |
size_t size /** number of bytes to output */ |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
354 |
) |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
355 |
{ |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
356 |
unsigned int i; |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
357 |
|
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
358 |
EC_DBG(""); |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
359 |
for (i = 0; i < size; i++) { |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
360 |
if (d1[i] == d2[i]) printk(".. "); |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
361 |
else printk("%02X ", d2[i]); |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
362 |
if ((i + 1) % 16 == 0) { |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
363 |
printk("\n"); |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
364 |
EC_DBG(""); |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
365 |
} |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
366 |
} |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
367 |
printk("\n"); |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
368 |
} |
f8a1e9f364a3
Introduced version number define.
Florian Pose <fp@igh-essen.com>
parents:
195
diff
changeset
|
369 |
|
251
c1d0b63a9302
EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents:
249
diff
changeset
|
370 |
/*****************************************************************************/ |
c1d0b63a9302
EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents:
249
diff
changeset
|
371 |
|
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
372 |
/** Prints slave states in clear text. |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
373 |
*/ |
325
7833cf70c4f2
VERSION 1.1: New realtime interface, only state machines.
Florian Pose <fp@igh-essen.com>
parents:
321
diff
changeset
|
374 |
size_t ec_state_string(uint8_t states, /**< slave states */ |
1337
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
375 |
char *buffer, /**< target buffer |
403
7bb931deccd9
Added EC_SLAVE_STATE_ACK_ERR to ec_state_string(); added EC_STATE_STRING_SIZE
Florian Pose <fp@igh-essen.com>
parents:
383
diff
changeset
|
376 |
(min. EC_STATE_STRING_SIZE bytes) */ |
1337
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
377 |
uint8_t multi /**< Show multi-state mask. */ |
325
7833cf70c4f2
VERSION 1.1: New realtime interface, only state machines.
Florian Pose <fp@igh-essen.com>
parents:
321
diff
changeset
|
378 |
) |
7833cf70c4f2
VERSION 1.1: New realtime interface, only state machines.
Florian Pose <fp@igh-essen.com>
parents:
321
diff
changeset
|
379 |
{ |
7833cf70c4f2
VERSION 1.1: New realtime interface, only state machines.
Florian Pose <fp@igh-essen.com>
parents:
321
diff
changeset
|
380 |
off_t off = 0; |
251
c1d0b63a9302
EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents:
249
diff
changeset
|
381 |
unsigned int first = 1; |
c1d0b63a9302
EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents:
249
diff
changeset
|
382 |
|
c1d0b63a9302
EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents:
249
diff
changeset
|
383 |
if (!states) { |
325
7833cf70c4f2
VERSION 1.1: New realtime interface, only state machines.
Florian Pose <fp@igh-essen.com>
parents:
321
diff
changeset
|
384 |
off += sprintf(buffer + off, "(unknown)"); |
7833cf70c4f2
VERSION 1.1: New realtime interface, only state machines.
Florian Pose <fp@igh-essen.com>
parents:
321
diff
changeset
|
385 |
return off; |
251
c1d0b63a9302
EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents:
249
diff
changeset
|
386 |
} |
c1d0b63a9302
EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents:
249
diff
changeset
|
387 |
|
1337
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
388 |
if (multi) { // multiple slaves |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
389 |
if (states & EC_SLAVE_STATE_INIT) { |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
390 |
off += sprintf(buffer + off, "INIT"); |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
391 |
first = 0; |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
392 |
} |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
393 |
if (states & EC_SLAVE_STATE_PREOP) { |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
394 |
if (!first) off += sprintf(buffer + off, ", "); |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
395 |
off += sprintf(buffer + off, "PREOP"); |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
396 |
first = 0; |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
397 |
} |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
398 |
if (states & EC_SLAVE_STATE_SAFEOP) { |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
399 |
if (!first) off += sprintf(buffer + off, ", "); |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
400 |
off += sprintf(buffer + off, "SAFEOP"); |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
401 |
first = 0; |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
402 |
} |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
403 |
if (states & EC_SLAVE_STATE_OP) { |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
404 |
if (!first) off += sprintf(buffer + off, ", "); |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
405 |
off += sprintf(buffer + off, "OP"); |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
406 |
} |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
407 |
} else { // single slave |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
408 |
if ((states & EC_SLAVE_STATE_MASK) == EC_SLAVE_STATE_INIT) { |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
409 |
off += sprintf(buffer + off, "INIT"); |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
410 |
} else if ((states & EC_SLAVE_STATE_MASK) == EC_SLAVE_STATE_PREOP) { |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
411 |
off += sprintf(buffer + off, "PREOP"); |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
412 |
} else if ((states & EC_SLAVE_STATE_MASK) == EC_SLAVE_STATE_BOOT) { |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
413 |
off += sprintf(buffer + off, "BOOT"); |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
414 |
} else if ((states & EC_SLAVE_STATE_MASK) == EC_SLAVE_STATE_SAFEOP) { |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
415 |
off += sprintf(buffer + off, "SAFEOP"); |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
416 |
} else if ((states & EC_SLAVE_STATE_MASK) == EC_SLAVE_STATE_OP) { |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
417 |
off += sprintf(buffer + off, "OP"); |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
418 |
} else { |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
419 |
off += sprintf(buffer + off, "(invalid)"); |
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
420 |
} |
251
c1d0b63a9302
EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents:
249
diff
changeset
|
421 |
first = 0; |
c1d0b63a9302
EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents:
249
diff
changeset
|
422 |
} |
1337
0253c74d0940
merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents:
1332
diff
changeset
|
423 |
|
403
7bb931deccd9
Added EC_SLAVE_STATE_ACK_ERR to ec_state_string(); added EC_STATE_STRING_SIZE
Florian Pose <fp@igh-essen.com>
parents:
383
diff
changeset
|
424 |
if (states & EC_SLAVE_STATE_ACK_ERR) { |
453
2ecaa53c6291
Changed output of ec_state_string() for error flag to "+ ERROR".
Florian Pose <fp@igh-essen.com>
parents:
448
diff
changeset
|
425 |
if (!first) off += sprintf(buffer + off, " + "); |
2ecaa53c6291
Changed output of ec_state_string() for error flag to "+ ERROR".
Florian Pose <fp@igh-essen.com>
parents:
448
diff
changeset
|
426 |
off += sprintf(buffer + off, "ERROR"); |
403
7bb931deccd9
Added EC_SLAVE_STATE_ACK_ERR to ec_state_string(); added EC_STATE_STRING_SIZE
Florian Pose <fp@igh-essen.com>
parents:
383
diff
changeset
|
427 |
} |
325
7833cf70c4f2
VERSION 1.1: New realtime interface, only state machines.
Florian Pose <fp@igh-essen.com>
parents:
321
diff
changeset
|
428 |
|
7833cf70c4f2
VERSION 1.1: New realtime interface, only state machines.
Florian Pose <fp@igh-essen.com>
parents:
321
diff
changeset
|
429 |
return off; |
251
c1d0b63a9302
EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents:
249
diff
changeset
|
430 |
} |
c1d0b63a9302
EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents:
249
diff
changeset
|
431 |
|
54
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
432 |
/****************************************************************************** |
195
674071846ee3
Translated all comments and documentation to english language.
Florian Pose <fp@igh-essen.com>
parents:
191
diff
changeset
|
433 |
* Device interface |
54
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
434 |
*****************************************************************************/ |
33
f4171b8aadf8
Master-Reservierung und Use-Count f?r NIC-Treiber.
Florian Pose <fp@igh-essen.com>
parents:
27
diff
changeset
|
435 |
|
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
436 |
/** Offers an EtherCAT device to a certain master. |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
437 |
* |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
438 |
* The master decides, if it wants to use the device for EtherCAT operation, |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
439 |
* or not. It is important, that the offered net_device is not used by the |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
440 |
* kernel IP stack. If the master, accepted the offer, the address of the |
1011 | 441 |
* newly created EtherCAT device is returned, else \a NULL is returned. |
442 |
* |
|
443 |
* \return Pointer to device, if accepted, or NULL if declined. |
|
806
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
444 |
* \ingroup DeviceInterface |
ab8daaabbe48
Renamed master module parameters, re-formatted code documentation.
Florian Pose <fp@igh-essen.com>
parents:
794
diff
changeset
|
445 |
*/ |
1011 | 446 |
ec_device_t *ecdev_offer( |
447 |
struct net_device *net_dev, /**< net_device to offer */ |
|
573
cdee4ea90ce9
Introduced device IDs; removed comment lines from 8139too; removed
Florian Pose <fp@igh-essen.com>
parents:
572
diff
changeset
|
448 |
ec_pollfunc_t poll, /**< device poll function */ |
1011 | 449 |
struct module *module /**< pointer to the module */ |
573
cdee4ea90ce9
Introduced device IDs; removed comment lines from 8139too; removed
Florian Pose <fp@igh-essen.com>
parents:
572
diff
changeset
|
450 |
) |
91
0120d6214948
Code-Dokumentation angepasst.
Florian Pose <fp@igh-essen.com>
parents:
88
diff
changeset
|
451 |
{ |
73
9f4ea66d89a3
Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst.
Florian Pose <fp@igh-essen.com>
parents:
64
diff
changeset
|
452 |
ec_master_t *master; |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
453 |
char str[20]; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
454 |
unsigned int i; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
455 |
|
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
456 |
for (i = 0; i < master_count; i++) { |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
457 |
master = &masters[i]; |
700
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
458 |
|
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
459 |
down(&master->device_sem); |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
460 |
if (master->main_device.dev) { // master already has a device |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
461 |
up(&master->device_sem); |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
462 |
continue; |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
463 |
} |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
464 |
|
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
465 |
if (ec_mac_equal(master->main_mac, net_dev->dev_addr) |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
466 |
|| ec_mac_is_broadcast(master->main_mac)) { |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
467 |
ec_mac_print(net_dev->dev_addr, str); |
578
f402b4bd2f4d
Removed ktype for module kobject; added backup device for master; device
Florian Pose <fp@igh-essen.com>
parents:
576
diff
changeset
|
468 |
EC_INFO("Accepting device %s for master %u.\n", |
f402b4bd2f4d
Removed ktype for module kobject; added backup device for master; device
Florian Pose <fp@igh-essen.com>
parents:
576
diff
changeset
|
469 |
str, master->index); |
573
cdee4ea90ce9
Introduced device IDs; removed comment lines from 8139too; removed
Florian Pose <fp@igh-essen.com>
parents:
572
diff
changeset
|
470 |
|
579
17c6fd3b076e
Made master devices persistent; added ec_device_attach() and ec_device_detach().
Florian Pose <fp@igh-essen.com>
parents:
578
diff
changeset
|
471 |
ec_device_attach(&master->main_device, net_dev, poll, module); |
573
cdee4ea90ce9
Introduced device IDs; removed comment lines from 8139too; removed
Florian Pose <fp@igh-essen.com>
parents:
572
diff
changeset
|
472 |
up(&master->device_sem); |
579
17c6fd3b076e
Made master devices persistent; added ec_device_attach() and ec_device_detach().
Florian Pose <fp@igh-essen.com>
parents:
578
diff
changeset
|
473 |
|
1548
b4ad9d06962d
Using snprintf for interface name.
Florian Pose <fp@igh-essen.com>
parents:
1469
diff
changeset
|
474 |
snprintf(net_dev->name, IFNAMSIZ, "ec%u", master->index); |
b4ad9d06962d
Using snprintf for interface name.
Florian Pose <fp@igh-essen.com>
parents:
1469
diff
changeset
|
475 |
|
1011 | 476 |
return &master->main_device; // offer accepted |
573
cdee4ea90ce9
Introduced device IDs; removed comment lines from 8139too; removed
Florian Pose <fp@igh-essen.com>
parents:
572
diff
changeset
|
477 |
} |
700
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
478 |
else { |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
479 |
up(&master->device_sem); |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
480 |
|
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
481 |
if (master->debug_level) { |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
482 |
ec_mac_print(net_dev->dev_addr, str); |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
483 |
EC_DBG("Master %u declined device %s.\n", master->index, str); |
a6b61f1a062d
Broadcast MAC address accepts first device.
Florian Pose <fp@igh-essen.com>
parents:
653
diff
changeset
|
484 |
} |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
485 |
} |
573
cdee4ea90ce9
Introduced device IDs; removed comment lines from 8139too; removed
Florian Pose <fp@igh-essen.com>
parents:
572
diff
changeset
|
486 |
} |
cdee4ea90ce9
Introduced device IDs; removed comment lines from 8139too; removed
Florian Pose <fp@igh-essen.com>
parents:
572
diff
changeset
|
487 |
|
1011 | 488 |
return NULL; // offer declined |
497
04552130dd54
Re-introduced ecdev_open() and ecdev_close(), to avoid a race condition regarding the link state.
Florian Pose <fp@igh-essen.com>
parents:
495
diff
changeset
|
489 |
} |
04552130dd54
Re-introduced ecdev_open() and ecdev_close(), to avoid a race condition regarding the link state.
Florian Pose <fp@igh-essen.com>
parents:
495
diff
changeset
|
490 |
|
54
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
491 |
/****************************************************************************** |
195
674071846ee3
Translated all comments and documentation to english language.
Florian Pose <fp@igh-essen.com>
parents:
191
diff
changeset
|
492 |
* Realtime interface |
54
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
493 |
*****************************************************************************/ |
33
f4171b8aadf8
Master-Reservierung und Use-Count f?r NIC-Treiber.
Florian Pose <fp@igh-essen.com>
parents:
27
diff
changeset
|
494 |
|
1312
74853e018898
Created backend versions of all API functions returing a pointer; using
Florian Pose <fp@igh-essen.com>
parents:
1279
diff
changeset
|
495 |
/** Request a master. |
74853e018898
Created backend versions of all API functions returing a pointer; using
Florian Pose <fp@igh-essen.com>
parents:
1279
diff
changeset
|
496 |
* |
74853e018898
Created backend versions of all API functions returing a pointer; using
Florian Pose <fp@igh-essen.com>
parents:
1279
diff
changeset
|
497 |
* Same as ecrt_request_master(), but with ERR_PTR() return value. |
74853e018898
Created backend versions of all API functions returing a pointer; using
Florian Pose <fp@igh-essen.com>
parents:
1279
diff
changeset
|
498 |
*/ |
1332
d62633fea8ed
merge -c1610 branches/stable-1.4: Added missing doxygen docs.
Florian Pose <fp@igh-essen.com>
parents:
1326
diff
changeset
|
499 |
ec_master_t *ecrt_request_master_err( |
d62633fea8ed
merge -c1610 branches/stable-1.4: Added missing doxygen docs.
Florian Pose <fp@igh-essen.com>
parents:
1326
diff
changeset
|
500 |
unsigned int master_index /**< Master index. */ |
d62633fea8ed
merge -c1610 branches/stable-1.4: Added missing doxygen docs.
Florian Pose <fp@igh-essen.com>
parents:
1326
diff
changeset
|
501 |
) |
54
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
502 |
{ |
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1209
diff
changeset
|
503 |
ec_master_t *master, *errptr = NULL; |
73
9f4ea66d89a3
Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst.
Florian Pose <fp@igh-essen.com>
parents:
64
diff
changeset
|
504 |
|
647
dc556a8c8fed
Replaced master variable 'atomic_t available' by integer and used
Florian Pose <fp@igh-essen.com>
parents:
639
diff
changeset
|
505 |
EC_INFO("Requesting master %u...\n", master_index); |
178
b84f69db8566
MERGE branches/sysfs -> trunk (whole SysFS implementation)
Florian Pose <fp@igh-essen.com>
parents:
161
diff
changeset
|
506 |
|
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
507 |
if (master_index >= master_count) { |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
508 |
EC_ERR("Invalid master index %u.\n", master_index); |
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1209
diff
changeset
|
509 |
errptr = ERR_PTR(-EINVAL); |
639
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
510 |
goto out_return; |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
511 |
} |
aa23c48dca2d
Allow only MAC addresses as device identifiers; replaced master list by
Florian Pose <fp@igh-essen.com>
parents:
579
diff
changeset
|
512 |
master = &masters[master_index]; |
178
b84f69db8566
MERGE branches/sysfs -> trunk (whole SysFS implementation)
Florian Pose <fp@igh-essen.com>
parents:
161
diff
changeset
|
513 |
|
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1209
diff
changeset
|
514 |
if (down_interruptible(&master_sem)) { |
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1209
diff
changeset
|
515 |
errptr = ERR_PTR(-EINTR); |
1189
acc6430bfb32
Use down_interruptible() wherever possible.
Florian Pose <fp@igh-essen.com>
parents:
1029
diff
changeset
|
516 |
goto out_return; |
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1209
diff
changeset
|
517 |
} |
1189
acc6430bfb32
Use down_interruptible() wherever possible.
Florian Pose <fp@igh-essen.com>
parents:
1029
diff
changeset
|
518 |
|
647
dc556a8c8fed
Replaced master variable 'atomic_t available' by integer and used
Florian Pose <fp@igh-essen.com>
parents:
639
diff
changeset
|
519 |
if (master->reserved) { |
dc556a8c8fed
Replaced master variable 'atomic_t available' by integer and used
Florian Pose <fp@igh-essen.com>
parents:
639
diff
changeset
|
520 |
up(&master_sem); |
dc556a8c8fed
Replaced master variable 'atomic_t available' by integer and used
Florian Pose <fp@igh-essen.com>
parents:
639
diff
changeset
|
521 |
EC_ERR("Master %u is already in use!\n", master_index); |
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1209
diff
changeset
|
522 |
errptr = ERR_PTR(-EBUSY); |
191 | 523 |
goto out_return; |
73
9f4ea66d89a3
Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst.
Florian Pose <fp@igh-essen.com>
parents:
64
diff
changeset
|
524 |
} |
647
dc556a8c8fed
Replaced master variable 'atomic_t available' by integer and used
Florian Pose <fp@igh-essen.com>
parents:
639
diff
changeset
|
525 |
master->reserved = 1; |
dc556a8c8fed
Replaced master variable 'atomic_t available' by integer and used
Florian Pose <fp@igh-essen.com>
parents:
639
diff
changeset
|
526 |
up(&master_sem); |
73
9f4ea66d89a3
Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst.
Florian Pose <fp@igh-essen.com>
parents:
64
diff
changeset
|
527 |
|
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1209
diff
changeset
|
528 |
if (down_interruptible(&master->device_sem)) { |
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1209
diff
changeset
|
529 |
errptr = ERR_PTR(-EINTR); |
1189
acc6430bfb32
Use down_interruptible() wherever possible.
Florian Pose <fp@igh-essen.com>
parents:
1029
diff
changeset
|
530 |
goto out_release; |
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1209
diff
changeset
|
531 |
} |
648
0a6d38ec463f
Made waiting for device semaphore uninterruptible.
Florian Pose <fp@igh-essen.com>
parents:
647
diff
changeset
|
532 |
|
1029
61ffe5f22306
Renamed master 'mode' to 'phase'.
Florian Pose <fp@igh-essen.com>
parents:
1014
diff
changeset
|
533 |
if (master->phase != EC_IDLE) { |
381
006d3653701d
Fixed race on duplicate device registering or device unregistering while requesting master.
Florian Pose <fp@igh-essen.com>
parents:
378
diff
changeset
|
534 |
up(&master->device_sem); |
647
dc556a8c8fed
Replaced master variable 'atomic_t available' by integer and used
Florian Pose <fp@igh-essen.com>
parents:
639
diff
changeset
|
535 |
EC_ERR("Master %u still waiting for devices!\n", master_index); |
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1209
diff
changeset
|
536 |
errptr = ERR_PTR(-ENODEV); |
191 | 537 |
goto out_release; |
73
9f4ea66d89a3
Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst.
Florian Pose <fp@igh-essen.com>
parents:
64
diff
changeset
|
538 |
} |
9f4ea66d89a3
Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst.
Florian Pose <fp@igh-essen.com>
parents:
64
diff
changeset
|
539 |
|
579
17c6fd3b076e
Made master devices persistent; added ec_device_attach() and ec_device_detach().
Florian Pose <fp@igh-essen.com>
parents:
578
diff
changeset
|
540 |
if (!try_module_get(master->main_device.module)) { |
381
006d3653701d
Fixed race on duplicate device registering or device unregistering while requesting master.
Florian Pose <fp@igh-essen.com>
parents:
378
diff
changeset
|
541 |
up(&master->device_sem); |
006d3653701d
Fixed race on duplicate device registering or device unregistering while requesting master.
Florian Pose <fp@igh-essen.com>
parents:
378
diff
changeset
|
542 |
EC_ERR("Device module is unloading!\n"); |
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1209
diff
changeset
|
543 |
errptr = ERR_PTR(-ENODEV); |
191 | 544 |
goto out_release; |
545 |
} |
|
546 |
||
381
006d3653701d
Fixed race on duplicate device registering or device unregistering while requesting master.
Florian Pose <fp@igh-essen.com>
parents:
378
diff
changeset
|
547 |
up(&master->device_sem); |
006d3653701d
Fixed race on duplicate device registering or device unregistering while requesting master.
Florian Pose <fp@igh-essen.com>
parents:
378
diff
changeset
|
548 |
|
1029
61ffe5f22306
Renamed master 'mode' to 'phase'.
Florian Pose <fp@igh-essen.com>
parents:
1014
diff
changeset
|
549 |
if (ec_master_enter_operation_phase(master)) { |
61ffe5f22306
Renamed master 'mode' to 'phase'.
Florian Pose <fp@igh-essen.com>
parents:
1014
diff
changeset
|
550 |
EC_ERR("Failed to enter OPERATION phase!\n"); |
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1209
diff
changeset
|
551 |
errptr = ERR_PTR(-EIO); |
446 | 552 |
goto out_module_put; |
377
ecac8252f114
Changes in ecrt_request_master(); minor output changes.
Florian Pose <fp@igh-essen.com>
parents:
361
diff
changeset
|
553 |
} |
ecac8252f114
Changes in ecrt_request_master(); minor output changes.
Florian Pose <fp@igh-essen.com>
parents:
361
diff
changeset
|
554 |
|
647
dc556a8c8fed
Replaced master variable 'atomic_t available' by integer and used
Florian Pose <fp@igh-essen.com>
parents:
639
diff
changeset
|
555 |
EC_INFO("Successfully requested master %u.\n", master_index); |
73
9f4ea66d89a3
Dynamische FMMU-Konfiguration, zwei Kopieroperationen eingespart, Einr?ckungen angepasst.
Florian Pose <fp@igh-essen.com>
parents:
64
diff
changeset
|
556 |
return master; |
54
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
557 |
|
191 | 558 |
out_module_put: |
579
17c6fd3b076e
Made master devices persistent; added ec_device_attach() and ec_device_detach().
Florian Pose <fp@igh-essen.com>
parents:
578
diff
changeset
|
559 |
module_put(master->main_device.module); |
191 | 560 |
out_release: |
647
dc556a8c8fed
Replaced master variable 'atomic_t available' by integer and used
Florian Pose <fp@igh-essen.com>
parents:
639
diff
changeset
|
561 |
master->reserved = 0; |
191 | 562 |
out_return: |
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1209
diff
changeset
|
563 |
return errptr; |
27
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
564 |
} |
d75ef6b46e33
EtherCAT-Master in eigenes Modul ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
diff
changeset
|
565 |
|
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
34
diff
changeset
|
566 |
/*****************************************************************************/ |
33
f4171b8aadf8
Master-Reservierung und Use-Count f?r NIC-Treiber.
Florian Pose <fp@igh-essen.com>
parents:
27
diff
changeset
|
567 |
|
1312
74853e018898
Created backend versions of all API functions returing a pointer; using
Florian Pose <fp@igh-essen.com>
parents:
1279
diff
changeset
|
568 |
ec_master_t *ecrt_request_master(unsigned int master_index) |
74853e018898
Created backend versions of all API functions returing a pointer; using
Florian Pose <fp@igh-essen.com>
parents:
1279
diff
changeset
|
569 |
{ |
74853e018898
Created backend versions of all API functions returing a pointer; using
Florian Pose <fp@igh-essen.com>
parents:
1279
diff
changeset
|
570 |
ec_master_t *master = ecrt_request_master_err(master_index); |
74853e018898
Created backend versions of all API functions returing a pointer; using
Florian Pose <fp@igh-essen.com>
parents:
1279
diff
changeset
|
571 |
return IS_ERR(master) ? NULL : master; |
74853e018898
Created backend versions of all API functions returing a pointer; using
Florian Pose <fp@igh-essen.com>
parents:
1279
diff
changeset
|
572 |
} |
74853e018898
Created backend versions of all API functions returing a pointer; using
Florian Pose <fp@igh-essen.com>
parents:
1279
diff
changeset
|
573 |
|
74853e018898
Created backend versions of all API functions returing a pointer; using
Florian Pose <fp@igh-essen.com>
parents:
1279
diff
changeset
|
574 |
/*****************************************************************************/ |
74853e018898
Created backend versions of all API functions returing a pointer; using
Florian Pose <fp@igh-essen.com>
parents:
1279
diff
changeset
|
575 |
|
792
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
758
diff
changeset
|
576 |
void ecrt_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
|
577 |
{ |
647
dc556a8c8fed
Replaced master variable 'atomic_t available' by integer and used
Florian Pose <fp@igh-essen.com>
parents:
639
diff
changeset
|
578 |
EC_INFO("Releasing master %u...\n", master->index); |
531
8d9339e7453f
Warn on duplicate master releasing.
Florian Pose <fp@igh-essen.com>
parents:
525
diff
changeset
|
579 |
|
997
652180478e95
Removed kobject from master and module. Sysfs is gone!
Florian Pose <fp@igh-essen.com>
parents:
954
diff
changeset
|
580 |
if (!master->reserved) { |
647
dc556a8c8fed
Replaced master variable 'atomic_t available' by integer and used
Florian Pose <fp@igh-essen.com>
parents:
639
diff
changeset
|
581 |
EC_WARN("Master %u was was not requested!\n", master->index); |
531
8d9339e7453f
Warn on duplicate master releasing.
Florian Pose <fp@igh-essen.com>
parents:
525
diff
changeset
|
582 |
return; |
8d9339e7453f
Warn on duplicate master releasing.
Florian Pose <fp@igh-essen.com>
parents:
525
diff
changeset
|
583 |
} |
8d9339e7453f
Warn on duplicate master releasing.
Florian Pose <fp@igh-essen.com>
parents:
525
diff
changeset
|
584 |
|
1029
61ffe5f22306
Renamed master 'mode' to 'phase'.
Florian Pose <fp@igh-essen.com>
parents:
1014
diff
changeset
|
585 |
ec_master_leave_operation_phase(master); |
151
1961b674466c
Plugfest: master_open()/close() ausgelagert.
Florian Pose <fp@igh-essen.com>
parents:
127
diff
changeset
|
586 |
|
579
17c6fd3b076e
Made master devices persistent; added ec_device_attach() and ec_device_detach().
Florian Pose <fp@igh-essen.com>
parents:
578
diff
changeset
|
587 |
module_put(master->main_device.module); |
647
dc556a8c8fed
Replaced master variable 'atomic_t available' by integer and used
Florian Pose <fp@igh-essen.com>
parents:
639
diff
changeset
|
588 |
master->reserved = 0; |
dc556a8c8fed
Replaced master variable 'atomic_t available' by integer and used
Florian Pose <fp@igh-essen.com>
parents:
639
diff
changeset
|
589 |
|
dc556a8c8fed
Replaced master variable 'atomic_t available' by integer and used
Florian Pose <fp@igh-essen.com>
parents:
639
diff
changeset
|
590 |
EC_INFO("Released master %u.\n", master->index); |
33
f4171b8aadf8
Master-Reservierung und Use-Count f?r NIC-Treiber.
Florian Pose <fp@igh-essen.com>
parents:
27
diff
changeset
|
591 |
} |
f4171b8aadf8
Master-Reservierung und Use-Count f?r NIC-Treiber.
Florian Pose <fp@igh-essen.com>
parents:
27
diff
changeset
|
592 |
|
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
34
diff
changeset
|
593 |
/*****************************************************************************/ |
54
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
594 |
|
792
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
758
diff
changeset
|
595 |
unsigned int ecrt_version_magic(void) |
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
758
diff
changeset
|
596 |
{ |
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
758
diff
changeset
|
597 |
return ECRT_VERSION_MAGIC; |
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
758
diff
changeset
|
598 |
} |
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
758
diff
changeset
|
599 |
|
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
758
diff
changeset
|
600 |
/*****************************************************************************/ |
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
758
diff
changeset
|
601 |
|
1209 | 602 |
/** Global request state type translation table. |
603 |
* |
|
604 |
* Translates an internal request state to an external one. |
|
605 |
*/ |
|
606 |
const ec_request_state_t ec_request_state_translation_table[] = { |
|
607 |
EC_REQUEST_UNUSED, // EC_INT_REQUEST_INIT, |
|
608 |
EC_REQUEST_BUSY, // EC_INT_REQUEST_QUEUED, |
|
609 |
EC_REQUEST_BUSY, // EC_INT_REQUEST_BUSY, |
|
610 |
EC_REQUEST_SUCCESS, // EC_INT_REQUEST_SUCCESS, |
|
611 |
EC_REQUEST_ERROR // EC_INT_REQUEST_FAILURE |
|
612 |
}; |
|
613 |
||
614 |
/*****************************************************************************/ |
|
615 |
||
199
04ecf40fc2e9
Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents:
197
diff
changeset
|
616 |
/** \cond */ |
04ecf40fc2e9
Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents:
197
diff
changeset
|
617 |
|
54
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
618 |
module_init(ec_init_module); |
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
619 |
module_exit(ec_cleanup_module); |
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
620 |
|
573
cdee4ea90ce9
Introduced device IDs; removed comment lines from 8139too; removed
Florian Pose <fp@igh-essen.com>
parents:
572
diff
changeset
|
621 |
EXPORT_SYMBOL(ecdev_offer); |
997
652180478e95
Removed kobject from master and module. Sysfs is gone!
Florian Pose <fp@igh-essen.com>
parents:
954
diff
changeset
|
622 |
|
104
052bc82d5442
MERGE branches/async -> trunk (alle Unterschiede ?bernommen)
Florian Pose <fp@igh-essen.com>
parents:
101
diff
changeset
|
623 |
EXPORT_SYMBOL(ecrt_request_master); |
052bc82d5442
MERGE branches/async -> trunk (alle Unterschiede ?bernommen)
Florian Pose <fp@igh-essen.com>
parents:
101
diff
changeset
|
624 |
EXPORT_SYMBOL(ecrt_release_master); |
545
6c4322e118d6
Added EXPORT macro for ecrt_version_magic().
Florian Pose <fp@igh-essen.com>
parents:
541
diff
changeset
|
625 |
EXPORT_SYMBOL(ecrt_version_magic); |
54
7506e67dd122
Vereinheitlichte Schnittstellen, Include-Verzeichnis und Module getrennt.
Florian Pose <fp@igh-essen.com>
parents:
52
diff
changeset
|
626 |
|
199
04ecf40fc2e9
Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents:
197
diff
changeset
|
627 |
/** \endcond */ |
04ecf40fc2e9
Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents:
197
diff
changeset
|
628 |
|
04ecf40fc2e9
Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents:
197
diff
changeset
|
629 |
/*****************************************************************************/ |