author | Florian Pose <fp@igh-essen.com> |
Fri, 23 Dec 2005 08:20:10 +0000 | |
changeset 40 | d07ebafe62dd |
parent 39 | 6965c23a6826 |
child 42 | a22a202d0f42 |
permissions | -rw-r--r-- |
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
1 |
/****************************************************************************** |
0 | 2 |
* |
3 |
* e c _ s l a v e . c |
|
4 |
* |
|
5 |
* Methoden für einen EtherCAT-Slave. |
|
6 |
* |
|
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
7 |
* $Id$ |
0 | 8 |
* |
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
9 |
*****************************************************************************/ |
0 | 10 |
|
24
d417dd9bdc2f
Wilhelms ?nderungen ?bernommen.
Florian Pose <fp@igh-essen.com>
parents:
23
diff
changeset
|
11 |
#include <linux/module.h> |
0 | 12 |
|
13 |
#include "ec_globals.h" |
|
14 |
#include "ec_slave.h" |
|
15 |
||
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
16 |
/*****************************************************************************/ |
0 | 17 |
|
18 |
/** |
|
19 |
EtherCAT-Slave-Konstruktor. |
|
20 |
||
21 |
Initialisiert einen EtherCAT-Slave. |
|
22 |
||
23 |
@param slave Zeiger auf den zu initialisierenden Slave |
|
24 |
*/ |
|
25 |
||
26 |
void EtherCAT_slave_init(EtherCAT_slave_t *slave) |
|
27 |
{ |
|
28 |
slave->type = 0; |
|
29 |
slave->revision = 0; |
|
30 |
slave->build = 0; |
|
31 |
slave->ring_position = 0; |
|
32 |
slave->station_address = 0; |
|
33 |
slave->vendor_id = 0; |
|
34 |
slave->product_code = 0; |
|
35 |
slave->revision_number = 0; |
|
5
6f2508af550c
Alle ?nderungen aus den Branches no_rtai und no_int nach Trunk portiert.
Florian Pose <fp@igh-essen.com>
parents:
2
diff
changeset
|
36 |
slave->serial_number = 0; |
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
37 |
slave->desc = NULL; |
0 | 38 |
slave->logical_address0 = 0; |
39 |
slave->current_state = ECAT_STATE_UNKNOWN; |
|
40 |
slave->requested_state = ECAT_STATE_UNKNOWN; |
|
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
41 |
slave->error_reported = 0; |
0 | 42 |
} |
43 |
||
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
44 |
/*****************************************************************************/ |
0 | 45 |
|
46 |
/** |
|
47 |
EtherCAT-Slave-Destruktor. |
|
48 |
||
49 |
Im Moment ohne Funktionalität. |
|
50 |
||
51 |
@param slave Zeiger auf den zu zerstörenden Slave |
|
52 |
*/ |
|
53 |
||
54 |
void EtherCAT_slave_clear(EtherCAT_slave_t *slave) |
|
55 |
{ |
|
56 |
// Nothing yet... |
|
57 |
} |
|
58 |
||
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
59 |
/*****************************************************************************/ |
0 | 60 |
|
61 |
/** |
|
62 |
Liest einen bestimmten Kanal des Slaves als Integer-Wert. |
|
63 |
||
64 |
Prüft zuerst, ob der entsprechende Slave eine |
|
65 |
bekannte Beschreibung besitzt, ob dort eine |
|
66 |
read()-Funktion hinterlegt ist und ob die angegebene |
|
67 |
Kanalnummer gültig ist. Wenn ja, wird der dekodierte |
|
68 |
Wert zurückgegeben, sonst ist der Wert 0. |
|
69 |
||
70 |
@param slave EtherCAT-Slave |
|
71 |
@param channel Kanalnummer |
|
72 |
||
73 |
@return Gelesener Wert bzw. 0 |
|
74 |
*/ |
|
75 |
||
76 |
int EtherCAT_read_value(EtherCAT_slave_t *slave, |
|
77 |
unsigned int channel) |
|
78 |
{ |
|
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
79 |
if (unlikely(!slave->desc)) { |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
80 |
if (likely(slave->error_reported)) { |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
81 |
printk(KERN_WARNING "EtherCAT: Reading failed on slave %04X (addr %0X)" |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
82 |
" - Slave has no description.\n", |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
83 |
slave->station_address, (unsigned int) slave); |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
84 |
slave->error_reported = 1; |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
85 |
} |
0 | 86 |
return 0; |
87 |
} |
|
88 |
||
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
89 |
if (unlikely(!slave->desc->read)) { |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
90 |
if (likely(slave->error_reported)) { |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
91 |
printk(KERN_WARNING "EtherCAT: Reading failed on slave %04X (addr %0X)" |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
92 |
" - Slave type (%s %s) has no read method.\n", |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
93 |
slave->station_address, (unsigned int) slave, |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
94 |
slave->desc->vendor_name, slave->desc->product_name); |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
95 |
slave->error_reported = 1; |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
96 |
} |
0 | 97 |
return 0; |
98 |
} |
|
99 |
||
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
100 |
if (unlikely(channel >= slave->desc->channels)) { |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
101 |
if (likely(slave->error_reported)) { |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
102 |
printk(KERN_WARNING "EtherCAT: Reading failed on slave %4X (addr %0X)" |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
103 |
" - Type (%s %s) has no channel %i.\n", |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
104 |
slave->station_address, (unsigned int) slave, |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
105 |
slave->desc->vendor_name, slave->desc->product_name, |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
106 |
channel); |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
107 |
slave->error_reported = 1; |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
108 |
} |
0 | 109 |
return 0; |
110 |
} |
|
111 |
||
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
112 |
if (unlikely(slave->error_reported)) |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
113 |
slave->error_reported = 0; |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
114 |
|
0 | 115 |
return slave->desc->read(slave->process_data, channel); |
116 |
} |
|
117 |
||
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
118 |
/*****************************************************************************/ |
0 | 119 |
|
120 |
/** |
|
121 |
Schreibt einen bestimmten Kanal des Slaves als Integer-Wert . |
|
122 |
||
123 |
Prüft zuerst, ob der entsprechende Slave eine |
|
124 |
bekannte Beschreibung besitzt, ob dort eine |
|
125 |
write()-Funktion hinterlegt ist und ob die angegebene |
|
126 |
Kanalnummer gültig ist. Wenn ja, wird der Wert entsprechend |
|
127 |
kodiert und geschrieben. |
|
128 |
||
129 |
@param slave EtherCAT-Slave |
|
130 |
@param channel Kanalnummer |
|
131 |
@param value Zu schreibender Wert |
|
132 |
*/ |
|
133 |
||
134 |
void EtherCAT_write_value(EtherCAT_slave_t *slave, |
|
135 |
unsigned int channel, |
|
136 |
int value) |
|
137 |
{ |
|
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
138 |
if (unlikely(!slave->desc)) { |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
139 |
if (likely(slave->error_reported)) { |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
140 |
printk(KERN_WARNING "EtherCAT: Writing failed on slave %04X (addr %0X)" |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
141 |
" - Slave has no description.\n", |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
142 |
slave->station_address, (unsigned int) slave); |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
143 |
slave->error_reported = 1; |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
144 |
} |
0 | 145 |
return; |
146 |
} |
|
147 |
||
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
148 |
if (unlikely(!slave->desc->write)) { |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
149 |
if (likely(slave->error_reported)) { |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
150 |
printk(KERN_WARNING "EtherCAT: Writing failed on slave %04X (addr %0X)" |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
151 |
" - Type (%s %s) has no write method.\n", |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
152 |
slave->station_address, (unsigned int) slave, |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
153 |
slave->desc->vendor_name, slave->desc->product_name); |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
154 |
slave->error_reported = 1; |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
155 |
} |
0 | 156 |
return; |
157 |
} |
|
158 |
||
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
159 |
if (unlikely(channel >= slave->desc->channels)) { |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
160 |
if (likely(slave->error_reported)) { |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
161 |
printk(KERN_WARNING "EtherCAT: Writing failed on slave %4X (addr %0X)" |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
162 |
" - Type (%s %s) has no channel %i.\n", |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
163 |
slave->station_address, (unsigned int) slave, |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
164 |
slave->desc->vendor_name, slave->desc->product_name, |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
165 |
channel); |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
166 |
slave->error_reported = 1; |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
167 |
} |
0 | 168 |
return; |
169 |
} |
|
170 |
||
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
171 |
if (unlikely(slave->error_reported)) |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
172 |
slave->error_reported = 0; |
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
173 |
|
0 | 174 |
slave->desc->write(slave->process_data, channel, value); |
175 |
} |
|
176 |
||
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
177 |
/*****************************************************************************/ |
24
d417dd9bdc2f
Wilhelms ?nderungen ?bernommen.
Florian Pose <fp@igh-essen.com>
parents:
23
diff
changeset
|
178 |
|
23
39364fbcd069
EXPORT_SYMBOLS im EtherCAT-Treiber.
Florian Pose <fp@igh-essen.com>
parents:
5
diff
changeset
|
179 |
EXPORT_SYMBOL(EtherCAT_write_value); |
24
d417dd9bdc2f
Wilhelms ?nderungen ?bernommen.
Florian Pose <fp@igh-essen.com>
parents:
23
diff
changeset
|
180 |
EXPORT_SYMBOL(EtherCAT_read_value); |
39
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
181 |
|
6965c23a6826
likely/unlikely, Fehlermeldungen in zyklischem Code begrenzt und Kommentare ge??ndert.
Florian Pose <fp@igh-essen.com>
parents:
26
diff
changeset
|
182 |
/*****************************************************************************/ |