| author | Florian Pose <fp@igh-essen.com> |
| Tue, 01 Dec 2009 16:54:59 +0100 | |
| changeset 1567 | 1babaa430b7b |
| parent 1513 | examples/mini/mini.c@60ca68d853b8 |
| child 1573 | 74bf584564b8 |
| permissions | -rw-r--r-- |
| 220 | 1 |
/****************************************************************************** |
2 |
* |
|
3 |
* $Id$ |
|
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:
1239
diff
changeset
|
5 |
* Copyright (C) 2006-2008 Florian Pose, Ingenieurgemeinschaft IgH |
| 220 | 6 |
* |
7 |
* This file is part of the IgH EtherCAT Master. |
|
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:
1239
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:
1239
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:
1239
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:
1239
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:
1239
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:
1239
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:
1239
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:
1239
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:
1239
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:
1239
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:
1239
diff
changeset
|
19 |
* with the IgH EtherCAT Master; if not, write to the Free Software |
| 220 | 20 |
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
21 |
* |
|
|
1363
11c0b2caa253
Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents:
1327
diff
changeset
|
22 |
* --- |
|
11c0b2caa253
Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents:
1327
diff
changeset
|
23 |
* |
|
11c0b2caa253
Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents:
1327
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:
1327
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:
1327
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:
226
diff
changeset
|
27 |
* |
| 220 | 28 |
*****************************************************************************/ |
29 |
||
|
1501
59990318c95b
Added semaphore header distinction in minimal example.
Florian Pose <fp@igh-essen.com>
parents:
1500
diff
changeset
|
30 |
#include <linux/version.h> |
| 220 | 31 |
#include <linux/module.h> |
32 |
#include <linux/timer.h> |
|
33 |
#include <linux/interrupt.h> |
|
|
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1212
diff
changeset
|
34 |
#include <linux/err.h> |
| 220 | 35 |
|
|
1501
59990318c95b
Added semaphore header distinction in minimal example.
Florian Pose <fp@igh-essen.com>
parents:
1500
diff
changeset
|
36 |
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27) |
|
59990318c95b
Added semaphore header distinction in minimal example.
Florian Pose <fp@igh-essen.com>
parents:
1500
diff
changeset
|
37 |
#include <linux/semaphore.h> |
|
59990318c95b
Added semaphore header distinction in minimal example.
Florian Pose <fp@igh-essen.com>
parents:
1500
diff
changeset
|
38 |
#else |
|
59990318c95b
Added semaphore header distinction in minimal example.
Florian Pose <fp@igh-essen.com>
parents:
1500
diff
changeset
|
39 |
#include <asm/semaphore.h> |
|
59990318c95b
Added semaphore header distinction in minimal example.
Florian Pose <fp@igh-essen.com>
parents:
1500
diff
changeset
|
40 |
#endif |
|
59990318c95b
Added semaphore header distinction in minimal example.
Florian Pose <fp@igh-essen.com>
parents:
1500
diff
changeset
|
41 |
|
|
223
daa5e5656b35
Applied new path information to example modules.
Florian Pose <fp@igh-essen.com>
parents:
220
diff
changeset
|
42 |
#include "../../include/ecrt.h" // EtherCAT realtime interface |
| 220 | 43 |
|
| 820 | 44 |
/*****************************************************************************/ |
45 |
||
|
858
69122084d066
Basic reading realtime Sdo access working.
Florian Pose <fp@igh-essen.com>
parents:
851
diff
changeset
|
46 |
// Module parameters |
| 220 | 47 |
#define FREQUENCY 100 |
|
858
69122084d066
Basic reading realtime Sdo access working.
Florian Pose <fp@igh-essen.com>
parents:
851
diff
changeset
|
48 |
|
|
1171
de880622f253
Alternative Pdo assignment for el3162.
Florian Pose <fp@igh-essen.com>
parents:
1082
diff
changeset
|
49 |
// Optional features |
| 1567 | 50 |
|
51 |
#define PFX "ec_tty_example: " |
|
| 820 | 52 |
|
53 |
/*****************************************************************************/ |
|
| 220 | 54 |
|
55 |
// EtherCAT |
|
|
612
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
56 |
static ec_master_t *master = NULL; |
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
57 |
static ec_master_state_t master_state = {};
|
|
1500
ed1a733efbc5
Improved the callback mechanism.
Florian Pose <fp@igh-essen.com>
parents:
1378
diff
changeset
|
58 |
struct semaphore master_sem; |
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
59 |
|
|
612
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
60 |
static ec_domain_t *domain1 = NULL; |
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
61 |
static ec_domain_state_t domain1_state = {};
|
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
62 |
|
|
1080
088a61306930
Removed MSR example; adapted RTAI example; README files for examples.
Florian Pose <fp@igh-essen.com>
parents:
1061
diff
changeset
|
63 |
// Timer |
| 820 | 64 |
static struct timer_list timer; |
65 |
||
66 |
/*****************************************************************************/ |
|
67 |
||
68 |
// process data |
|
69 |
static uint8_t *domain1_pd; // process data memory |
|
70 |
||
| 1567 | 71 |
#define BusCouplerPos 0, 0 |
72 |
#define SerialPos 0, 1 |
|
73 |
||
74 |
#define Beckhoff_EK1100 0x00000002, 0x044c2c52 |
|
75 |
#define Beckhoff_EL6002 0x00000002, 0x17723052 |
|
|
1179
c0e6adec1aee
Added analog output to minimal example.
Florian Pose <fp@igh-essen.com>
parents:
1171
diff
changeset
|
76 |
|
|
1327
4d179b06dd3c
merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms.
Florian Pose <fp@igh-essen.com>
parents:
1326
diff
changeset
|
77 |
// offsets for PDO entries |
| 1567 | 78 |
static unsigned int off_ctrl; |
79 |
static unsigned int off_tx; |
|
80 |
static unsigned int off_status; |
|
81 |
static unsigned int off_rx; |
|
| 820 | 82 |
|
|
1080
088a61306930
Removed MSR example; adapted RTAI example; README files for examples.
Florian Pose <fp@igh-essen.com>
parents:
1061
diff
changeset
|
83 |
const static ec_pdo_entry_reg_t domain1_regs[] = {
|
| 1567 | 84 |
{SerialPos, Beckhoff_EL6002, 0x7001, 0x01, &off_ctrl},
|
85 |
{SerialPos, Beckhoff_EL6002, 0x7000, 0x11, &off_tx},
|
|
86 |
{SerialPos, Beckhoff_EL6002, 0x6001, 0x01, &off_status},
|
|
87 |
{SerialPos, Beckhoff_EL6002, 0x6000, 0x11, &off_rx},
|
|
|
1080
088a61306930
Removed MSR example; adapted RTAI example; README files for examples.
Florian Pose <fp@igh-essen.com>
parents:
1061
diff
changeset
|
88 |
{}
|
|
088a61306930
Removed MSR example; adapted RTAI example; README files for examples.
Florian Pose <fp@igh-essen.com>
parents:
1061
diff
changeset
|
89 |
}; |
|
088a61306930
Removed MSR example; adapted RTAI example; README files for examples.
Florian Pose <fp@igh-essen.com>
parents:
1061
diff
changeset
|
90 |
|
|
088a61306930
Removed MSR example; adapted RTAI example; README files for examples.
Florian Pose <fp@igh-essen.com>
parents:
1061
diff
changeset
|
91 |
static unsigned int counter = 0; |
| 1567 | 92 |
|
93 |
typedef enum {
|
|
94 |
SER_REQUEST_INIT, |
|
95 |
SER_WAIT_FOR_INIT_RESPONSE, |
|
96 |
SER_READY |
|
97 |
} serial_state_t; |
|
98 |
||
99 |
typedef struct {
|
|
100 |
size_t max_tx_data_size; |
|
101 |
size_t max_rx_data_size; |
|
102 |
||
103 |
uint8_t *tx_data; |
|
104 |
uint8_t tx_data_size; |
|
105 |
||
106 |
serial_state_t state; |
|
107 |
||
108 |
uint8_t tx_request_toggle; |
|
109 |
uint8_t tx_accepted_toggle; |
|
110 |
||
111 |
uint8_t rx_request_toggle; |
|
112 |
uint8_t rx_accepted_toggle; |
|
113 |
||
114 |
uint16_t control; |
|
115 |
} serial_device_t; |
|
116 |
||
117 |
static serial_device_t *ser = NULL; |
|
118 |
static char tx_data[] = "ATZ\r\n"; |
|
119 |
static off_t tx_off = 0; |
|
120 |
||
121 |
/*****************************************************************************/ |
|
122 |
||
123 |
/* Slave 1, "EL6002" |
|
124 |
* Vendor ID: 0x00000002 |
|
125 |
* Product code: 0x17723052 |
|
126 |
* Revision number: 0x00100000 |
|
127 |
*/ |
|
128 |
||
129 |
ec_pdo_entry_info_t slave_1_pdo_entries[] = {
|
|
130 |
{0x7001, 0x01, 16}, /* Ctrl */
|
|
131 |
{0x7000, 0x11, 8}, /* Data Out 0 */
|
|
132 |
{0x7000, 0x12, 8}, /* Data Out 1 */
|
|
133 |
{0x7000, 0x13, 8}, /* Data Out 2 */
|
|
134 |
{0x7000, 0x14, 8}, /* Data Out 3 */
|
|
135 |
{0x7000, 0x15, 8}, /* Data Out 4 */
|
|
136 |
{0x7000, 0x16, 8}, /* Data Out 5 */
|
|
137 |
{0x7000, 0x17, 8}, /* Data Out 6 */
|
|
138 |
{0x7000, 0x18, 8}, /* Data Out 7 */
|
|
139 |
{0x7000, 0x19, 8}, /* Data Out 8 */
|
|
140 |
{0x7000, 0x1a, 8}, /* Data Out 9 */
|
|
141 |
{0x7000, 0x1b, 8}, /* Data Out 10 */
|
|
142 |
{0x7000, 0x1c, 8}, /* Data Out 11 */
|
|
143 |
{0x7000, 0x1d, 8}, /* Data Out 12 */
|
|
144 |
{0x7000, 0x1e, 8}, /* Data Out 13 */
|
|
145 |
{0x7000, 0x1f, 8}, /* Data Out 14 */
|
|
146 |
{0x7000, 0x20, 8}, /* Data Out 15 */
|
|
147 |
{0x7000, 0x21, 8}, /* Data Out 16 */
|
|
148 |
{0x7000, 0x22, 8}, /* Data Out 17 */
|
|
149 |
{0x7000, 0x23, 8}, /* Data Out 18 */
|
|
150 |
{0x7000, 0x24, 8}, /* Data Out 19 */
|
|
151 |
{0x7000, 0x25, 8}, /* Data Out 20 */
|
|
152 |
{0x7000, 0x26, 8}, /* Data Out 21 */
|
|
153 |
{0x7011, 0x01, 16}, /* Ctrl */
|
|
154 |
{0x7010, 0x11, 8}, /* Data Out 0 */
|
|
155 |
{0x7010, 0x12, 8}, /* Data Out 1 */
|
|
156 |
{0x7010, 0x13, 8}, /* Data Out 2 */
|
|
157 |
{0x7010, 0x14, 8}, /* Data Out 3 */
|
|
158 |
{0x7010, 0x15, 8}, /* Data Out 4 */
|
|
159 |
{0x7010, 0x16, 8}, /* Data Out 5 */
|
|
160 |
{0x7010, 0x17, 8}, /* Data Out 6 */
|
|
161 |
{0x7010, 0x18, 8}, /* Data Out 7 */
|
|
162 |
{0x7010, 0x19, 8}, /* Data Out 8 */
|
|
163 |
{0x7010, 0x1a, 8}, /* Data Out 9 */
|
|
164 |
{0x7010, 0x1b, 8}, /* Data Out 10 */
|
|
165 |
{0x7010, 0x1c, 8}, /* Data Out 11 */
|
|
166 |
{0x7010, 0x1d, 8}, /* Data Out 12 */
|
|
167 |
{0x7010, 0x1e, 8}, /* Data Out 13 */
|
|
168 |
{0x7010, 0x1f, 8}, /* Data Out 14 */
|
|
169 |
{0x7010, 0x20, 8}, /* Data Out 15 */
|
|
170 |
{0x7010, 0x21, 8}, /* Data Out 16 */
|
|
171 |
{0x7010, 0x22, 8}, /* Data Out 17 */
|
|
172 |
{0x7010, 0x23, 8}, /* Data Out 18 */
|
|
173 |
{0x7010, 0x24, 8}, /* Data Out 19 */
|
|
174 |
{0x7010, 0x25, 8}, /* Data Out 20 */
|
|
175 |
{0x7010, 0x26, 8}, /* Data Out 21 */
|
|
176 |
{0x6001, 0x01, 16}, /* Status */
|
|
177 |
{0x6000, 0x11, 8}, /* Data In 0 */
|
|
178 |
{0x6000, 0x12, 8}, /* Data In 1 */
|
|
179 |
{0x6000, 0x13, 8}, /* Data In 2 */
|
|
180 |
{0x6000, 0x14, 8}, /* Data In 3 */
|
|
181 |
{0x6000, 0x15, 8}, /* Data In 4 */
|
|
182 |
{0x6000, 0x16, 8}, /* Data In 5 */
|
|
183 |
{0x6000, 0x17, 8}, /* Data In 6 */
|
|
184 |
{0x6000, 0x18, 8}, /* Data In 7 */
|
|
185 |
{0x6000, 0x19, 8}, /* Data In 8 */
|
|
186 |
{0x6000, 0x1a, 8}, /* Data In 9 */
|
|
187 |
{0x6000, 0x1b, 8}, /* Data In 10 */
|
|
188 |
{0x6000, 0x1c, 8}, /* Data In 11 */
|
|
189 |
{0x6000, 0x1d, 8}, /* Data In 12 */
|
|
190 |
{0x6000, 0x1e, 8}, /* Data In 13 */
|
|
191 |
{0x6000, 0x1f, 8}, /* Data In 14 */
|
|
192 |
{0x6000, 0x20, 8}, /* Data In 15 */
|
|
193 |
{0x6000, 0x21, 8}, /* Data In 16 */
|
|
194 |
{0x6000, 0x22, 8}, /* Data In 17 */
|
|
195 |
{0x6000, 0x23, 8}, /* Data In 18 */
|
|
196 |
{0x6000, 0x24, 8}, /* Data In 19 */
|
|
197 |
{0x6000, 0x25, 8}, /* Data In 20 */
|
|
198 |
{0x6000, 0x26, 8}, /* Data In 21 */
|
|
199 |
{0x6011, 0x01, 16}, /* Status */
|
|
200 |
{0x6010, 0x11, 8}, /* Data In 0 */
|
|
201 |
{0x6010, 0x12, 8}, /* Data In 1 */
|
|
202 |
{0x6010, 0x13, 8}, /* Data In 2 */
|
|
203 |
{0x6010, 0x14, 8}, /* Data In 3 */
|
|
204 |
{0x6010, 0x15, 8}, /* Data In 4 */
|
|
205 |
{0x6010, 0x16, 8}, /* Data In 5 */
|
|
206 |
{0x6010, 0x17, 8}, /* Data In 6 */
|
|
207 |
{0x6010, 0x18, 8}, /* Data In 7 */
|
|
208 |
{0x6010, 0x19, 8}, /* Data In 8 */
|
|
209 |
{0x6010, 0x1a, 8}, /* Data In 9 */
|
|
210 |
{0x6010, 0x1b, 8}, /* Data In 10 */
|
|
211 |
{0x6010, 0x1c, 8}, /* Data In 11 */
|
|
212 |
{0x6010, 0x1d, 8}, /* Data In 12 */
|
|
213 |
{0x6010, 0x1e, 8}, /* Data In 13 */
|
|
214 |
{0x6010, 0x1f, 8}, /* Data In 14 */
|
|
215 |
{0x6010, 0x20, 8}, /* Data In 15 */
|
|
216 |
{0x6010, 0x21, 8}, /* Data In 16 */
|
|
217 |
{0x6010, 0x22, 8}, /* Data In 17 */
|
|
218 |
{0x6010, 0x23, 8}, /* Data In 18 */
|
|
219 |
{0x6010, 0x24, 8}, /* Data In 19 */
|
|
220 |
{0x6010, 0x25, 8}, /* Data In 20 */
|
|
221 |
{0x6010, 0x26, 8}, /* Data In 21 */
|
|
|
1171
de880622f253
Alternative Pdo assignment for el3162.
Florian Pose <fp@igh-essen.com>
parents:
1082
diff
changeset
|
222 |
}; |
|
de880622f253
Alternative Pdo assignment for el3162.
Florian Pose <fp@igh-essen.com>
parents:
1082
diff
changeset
|
223 |
|
| 1567 | 224 |
ec_pdo_info_t slave_1_pdos[] = {
|
225 |
{0x1604, 23, slave_1_pdo_entries + 0}, /* COM RxPDO-Map Outputs Ch.1 */
|
|
226 |
{0x1605, 23, slave_1_pdo_entries + 23}, /* COM RxPDO-Map Outputs Ch.2 */
|
|
227 |
{0x1a04, 23, slave_1_pdo_entries + 46}, /* COM TxPDO-Map Inputs Ch.1 */
|
|
228 |
{0x1a05, 23, slave_1_pdo_entries + 69}, /* COM TxPDO-Map Inputs Ch.2 */
|
|
|
1179
c0e6adec1aee
Added analog output to minimal example.
Florian Pose <fp@igh-essen.com>
parents:
1171
diff
changeset
|
229 |
}; |
|
c0e6adec1aee
Added analog output to minimal example.
Florian Pose <fp@igh-essen.com>
parents:
1171
diff
changeset
|
230 |
|
| 1567 | 231 |
ec_sync_info_t slave_1_syncs[] = {
|
232 |
{0, EC_DIR_OUTPUT, 0, NULL, EC_WD_DISABLE},
|
|
233 |
{1, EC_DIR_INPUT, 0, NULL, EC_WD_DISABLE},
|
|
234 |
{2, EC_DIR_OUTPUT, 2, slave_1_pdos + 0, EC_WD_DISABLE},
|
|
235 |
{3, EC_DIR_INPUT, 2, slave_1_pdos + 2, EC_WD_DISABLE},
|
|
236 |
{0xff}
|
|
|
1171
de880622f253
Alternative Pdo assignment for el3162.
Florian Pose <fp@igh-essen.com>
parents:
1082
diff
changeset
|
237 |
}; |
| 1567 | 238 |
|
239 |
/****************************************************************************/ |
|
240 |
||
241 |
int serial_init(serial_device_t *ser, size_t max_tx, size_t max_rx) |
|
242 |
{
|
|
243 |
ser->max_tx_data_size = max_tx; |
|
244 |
ser->max_rx_data_size = max_rx; |
|
245 |
ser->tx_data = NULL; |
|
246 |
ser->tx_data_size = 0; |
|
247 |
ser->state = SER_REQUEST_INIT; |
|
248 |
ser->tx_request_toggle = 0; |
|
249 |
ser->rx_accepted_toggle = 0; |
|
250 |
ser->control = 0x0000; |
|
251 |
||
252 |
if (max_tx > 0) {
|
|
253 |
ser->tx_data = kmalloc(max_tx, GFP_KERNEL); |
|
254 |
if (ser->tx_data == NULL) {
|
|
255 |
return -ENOMEM; |
|
256 |
} |
|
257 |
} |
|
258 |
||
259 |
return 0; |
|
260 |
} |
|
261 |
||
262 |
/****************************************************************************/ |
|
263 |
||
264 |
void serial_clear(serial_device_t *ser) |
|
265 |
{
|
|
266 |
if (ser->tx_data) {
|
|
267 |
kfree(ser->tx_data); |
|
268 |
} |
|
269 |
} |
|
270 |
||
271 |
/****************************************************************************/ |
|
272 |
||
273 |
void serial_run(serial_device_t *ser, uint16_t status, uint8_t *rx_data) |
|
274 |
{
|
|
275 |
uint8_t tx_accepted_toggle, rx_request_toggle; |
|
276 |
||
277 |
switch (ser->state) {
|
|
278 |
case SER_READY: |
|
279 |
||
280 |
/* Send data */ |
|
281 |
||
282 |
tx_accepted_toggle = status & 0x0001; |
|
283 |
if (tx_accepted_toggle != ser->tx_accepted_toggle) { // ready
|
|
284 |
// send new data |
|
285 |
size_t rem = sizeof(tx_data) - tx_off; |
|
286 |
if (rem > 0) {
|
|
287 |
if (rem < ser->max_tx_data_size) {
|
|
288 |
ser->tx_data_size = rem; |
|
289 |
} else {
|
|
290 |
ser->tx_data_size = ser->max_tx_data_size; |
|
291 |
} |
|
292 |
printk(KERN_INFO PFX "Sending %u bytes.\n", ser->tx_data_size); |
|
293 |
memcpy(ser->tx_data, tx_data, ser->tx_data_size); |
|
294 |
tx_off += ser->tx_data_size; |
|
295 |
ser->tx_request_toggle = !ser->tx_request_toggle; |
|
296 |
ser->tx_accepted_toggle = tx_accepted_toggle; |
|
297 |
} |
|
298 |
} |
|
299 |
||
300 |
/* Receive data */ |
|
301 |
||
302 |
rx_request_toggle = status & 0x0002; |
|
303 |
if (rx_request_toggle != ser->rx_request_toggle) {
|
|
304 |
uint8_t rx_data_size = status >> 8, i; |
|
305 |
ser->rx_request_toggle = rx_request_toggle; |
|
306 |
printk(KERN_INFO PFX "Received %u bytes:\n", rx_data_size); |
|
307 |
for (i = 0; i < rx_data_size; i++) {
|
|
308 |
printk(KERN_INFO PFX "%02x\n", rx_data[i]); |
|
309 |
} |
|
310 |
ser->rx_accepted_toggle = !ser->rx_accepted_toggle; |
|
311 |
} |
|
312 |
||
313 |
ser->control = |
|
314 |
ser->tx_request_toggle | |
|
315 |
ser->rx_accepted_toggle << 1 | |
|
316 |
ser->tx_data_size << 8; |
|
317 |
break; |
|
318 |
||
319 |
case SER_REQUEST_INIT: |
|
320 |
if (status & (1 << 2)) {
|
|
321 |
ser->control = 0x0000; |
|
322 |
ser->state = SER_WAIT_FOR_INIT_RESPONSE; |
|
323 |
} else {
|
|
324 |
ser->control = 1 << 2; // CW.2, request initialization |
|
325 |
} |
|
326 |
break; |
|
327 |
||
328 |
case SER_WAIT_FOR_INIT_RESPONSE: |
|
329 |
if (!(status & (1 << 2))) {
|
|
330 |
printk(KERN_INFO PFX "Init successful.\n"); |
|
331 |
ser->tx_accepted_toggle = 1; |
|
332 |
ser->control = 0x0000; |
|
333 |
ser->state = SER_READY; |
|
334 |
} |
|
335 |
break; |
|
336 |
} |
|
337 |
||
338 |
} |
|
| 1209 | 339 |
|
|
858
69122084d066
Basic reading realtime Sdo access working.
Florian Pose <fp@igh-essen.com>
parents:
851
diff
changeset
|
340 |
/*****************************************************************************/ |
|
69122084d066
Basic reading realtime Sdo access working.
Florian Pose <fp@igh-essen.com>
parents:
851
diff
changeset
|
341 |
|
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
342 |
void check_domain1_state(void) |
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
343 |
{
|
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
344 |
ec_domain_state_t ds; |
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
345 |
|
|
1500
ed1a733efbc5
Improved the callback mechanism.
Florian Pose <fp@igh-essen.com>
parents:
1378
diff
changeset
|
346 |
down(&master_sem); |
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
347 |
ecrt_domain_state(domain1, &ds); |
|
1500
ed1a733efbc5
Improved the callback mechanism.
Florian Pose <fp@igh-essen.com>
parents:
1378
diff
changeset
|
348 |
up(&master_sem); |
|
1022
8e49b519e6ba
Implemented ecrt_slave_config_state(); minor changes in
Florian Pose <fp@igh-essen.com>
parents:
909
diff
changeset
|
349 |
|
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
350 |
if (ds.working_counter != domain1_state.working_counter) |
|
1022
8e49b519e6ba
Implemented ecrt_slave_config_state(); minor changes in
Florian Pose <fp@igh-essen.com>
parents:
909
diff
changeset
|
351 |
printk(KERN_INFO PFX "Domain1: WC %u.\n", ds.working_counter); |
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
352 |
if (ds.wc_state != domain1_state.wc_state) |
|
1022
8e49b519e6ba
Implemented ecrt_slave_config_state(); minor changes in
Florian Pose <fp@igh-essen.com>
parents:
909
diff
changeset
|
353 |
printk(KERN_INFO PFX "Domain1: State %u.\n", ds.wc_state); |
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
354 |
|
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
355 |
domain1_state = ds; |
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
356 |
} |
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
357 |
|
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
358 |
/*****************************************************************************/ |
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
359 |
|
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
360 |
void check_master_state(void) |
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
361 |
{
|
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
362 |
ec_master_state_t ms; |
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
363 |
|
|
1500
ed1a733efbc5
Improved the callback mechanism.
Florian Pose <fp@igh-essen.com>
parents:
1378
diff
changeset
|
364 |
down(&master_sem); |
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
365 |
ecrt_master_state(master, &ms); |
|
1500
ed1a733efbc5
Improved the callback mechanism.
Florian Pose <fp@igh-essen.com>
parents:
1378
diff
changeset
|
366 |
up(&master_sem); |
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
367 |
|
|
1022
8e49b519e6ba
Implemented ecrt_slave_config_state(); minor changes in
Florian Pose <fp@igh-essen.com>
parents:
909
diff
changeset
|
368 |
if (ms.slaves_responding != master_state.slaves_responding) |
|
8e49b519e6ba
Implemented ecrt_slave_config_state(); minor changes in
Florian Pose <fp@igh-essen.com>
parents:
909
diff
changeset
|
369 |
printk(KERN_INFO PFX "%u slave(s).\n", ms.slaves_responding); |
|
8e49b519e6ba
Implemented ecrt_slave_config_state(); minor changes in
Florian Pose <fp@igh-essen.com>
parents:
909
diff
changeset
|
370 |
if (ms.al_states != master_state.al_states) |
|
8e49b519e6ba
Implemented ecrt_slave_config_state(); minor changes in
Florian Pose <fp@igh-essen.com>
parents:
909
diff
changeset
|
371 |
printk(KERN_INFO PFX "AL states: 0x%02X.\n", ms.al_states); |
|
8e49b519e6ba
Implemented ecrt_slave_config_state(); minor changes in
Florian Pose <fp@igh-essen.com>
parents:
909
diff
changeset
|
372 |
if (ms.link_up != master_state.link_up) |
|
8e49b519e6ba
Implemented ecrt_slave_config_state(); minor changes in
Florian Pose <fp@igh-essen.com>
parents:
909
diff
changeset
|
373 |
printk(KERN_INFO PFX "Link is %s.\n", ms.link_up ? "up" : "down"); |
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
374 |
|
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
375 |
master_state = ms; |
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
376 |
} |
| 220 | 377 |
|
378 |
/*****************************************************************************/ |
|
379 |
||
| 820 | 380 |
void cyclic_task(unsigned long data) |
381 |
{
|
|
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
382 |
// receive process data |
|
1500
ed1a733efbc5
Improved the callback mechanism.
Florian Pose <fp@igh-essen.com>
parents:
1378
diff
changeset
|
383 |
down(&master_sem); |
|
325
7833cf70c4f2
VERSION 1.1: New realtime interface, only state machines.
Florian Pose <fp@igh-essen.com>
parents:
280
diff
changeset
|
384 |
ecrt_master_receive(master); |
| 220 | 385 |
ecrt_domain_process(domain1); |
|
1500
ed1a733efbc5
Improved the callback mechanism.
Florian Pose <fp@igh-essen.com>
parents:
1378
diff
changeset
|
386 |
up(&master_sem); |
| 220 | 387 |
|
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
388 |
// check process data state (optional) |
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
389 |
check_domain1_state(); |
|
512
24292123d174
Shorter critical sections in examples.
Florian Pose <fp@igh-essen.com>
parents:
509
diff
changeset
|
390 |
|
|
24292123d174
Shorter critical sections in examples.
Florian Pose <fp@igh-essen.com>
parents:
509
diff
changeset
|
391 |
if (counter) {
|
|
24292123d174
Shorter critical sections in examples.
Florian Pose <fp@igh-essen.com>
parents:
509
diff
changeset
|
392 |
counter--; |
|
858
69122084d066
Basic reading realtime Sdo access working.
Florian Pose <fp@igh-essen.com>
parents:
851
diff
changeset
|
393 |
} else { // do this at 1 Hz
|
|
512
24292123d174
Shorter critical sections in examples.
Florian Pose <fp@igh-essen.com>
parents:
509
diff
changeset
|
394 |
counter = FREQUENCY; |
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
395 |
|
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
396 |
// check for master state (optional) |
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
397 |
check_master_state(); |
|
1022
8e49b519e6ba
Implemented ecrt_slave_config_state(); minor changes in
Florian Pose <fp@igh-essen.com>
parents:
909
diff
changeset
|
398 |
|
| 1567 | 399 |
tx_off = 0; |
400 |
} |
|
401 |
||
402 |
serial_run(ser, EC_READ_U16(domain1_pd + off_status), domain1_pd + off_rx); |
|
403 |
EC_WRITE_U16(domain1_pd + off_ctrl, ser->control); |
|
404 |
memcpy(domain1_pd + off_tx, ser->tx_data, 22); |
|
|
818
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
405 |
|
|
b6c87ae254c9
Calculate expected working counter for domains.
Florian Pose <fp@igh-essen.com>
parents:
814
diff
changeset
|
406 |
// send process data |
|
1500
ed1a733efbc5
Improved the callback mechanism.
Florian Pose <fp@igh-essen.com>
parents:
1378
diff
changeset
|
407 |
down(&master_sem); |
|
509
87baea61d0c7
Adjusted examples to 1.2.0 interface changes.
Florian Pose <fp@igh-essen.com>
parents:
472
diff
changeset
|
408 |
ecrt_domain_queue(domain1); |
|
325
7833cf70c4f2
VERSION 1.1: New realtime interface, only state machines.
Florian Pose <fp@igh-essen.com>
parents:
280
diff
changeset
|
409 |
ecrt_master_send(master); |
|
1500
ed1a733efbc5
Improved the callback mechanism.
Florian Pose <fp@igh-essen.com>
parents:
1378
diff
changeset
|
410 |
up(&master_sem); |
| 220 | 411 |
|
412 |
// restart timer |
|
413 |
timer.expires += HZ / FREQUENCY; |
|
414 |
add_timer(&timer); |
|
415 |
} |
|
416 |
||
417 |
/*****************************************************************************/ |
|
418 |
||
|
1513
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
419 |
void send_callback(void *cb_data) |
|
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
420 |
{
|
|
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
421 |
ec_master_t *m = (ec_master_t *) cb_data; |
|
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
422 |
down(&master_sem); |
|
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
423 |
ecrt_master_send_ext(m); |
|
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
424 |
up(&master_sem); |
|
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
425 |
} |
|
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
426 |
|
|
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
427 |
/*****************************************************************************/ |
|
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
428 |
|
|
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
429 |
void receive_callback(void *cb_data) |
|
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
430 |
{
|
|
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
431 |
ec_master_t *m = (ec_master_t *) cb_data; |
|
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
432 |
down(&master_sem); |
|
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
433 |
ecrt_master_receive(m); |
|
1500
ed1a733efbc5
Improved the callback mechanism.
Florian Pose <fp@igh-essen.com>
parents:
1378
diff
changeset
|
434 |
up(&master_sem); |
| 220 | 435 |
} |
436 |
||
437 |
/*****************************************************************************/ |
|
438 |
||
439 |
int __init init_mini_module(void) |
|
440 |
{
|
|
|
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1212
diff
changeset
|
441 |
int ret = -1; |
|
792
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
654
diff
changeset
|
442 |
ec_slave_config_t *sc; |
|
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
654
diff
changeset
|
443 |
|
|
612
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
444 |
printk(KERN_INFO PFX "Starting...\n"); |
| 220 | 445 |
|
| 1567 | 446 |
ser = kmalloc(sizeof(*ser), GFP_KERNEL); |
447 |
if (ser == NULL) {
|
|
448 |
printk(KERN_ERR PFX "Failed to allocate serial device object.\n"); |
|
449 |
return -ENOMEM; |
|
450 |
} |
|
451 |
ret = serial_init(ser, 22, 22); |
|
452 |
if (ret) {
|
|
453 |
printk(KERN_ERR PFX "Failed to init serial device object.\n"); |
|
454 |
return ret; |
|
455 |
} |
|
456 |
||
|
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1212
diff
changeset
|
457 |
master = ecrt_request_master(0); |
|
1378
1853f6c0b9b2
Removed IS_ERR() from minimal example.
Florian Pose <fp@igh-essen.com>
parents:
1363
diff
changeset
|
458 |
if (!master) {
|
|
1853f6c0b9b2
Removed IS_ERR() from minimal example.
Florian Pose <fp@igh-essen.com>
parents:
1363
diff
changeset
|
459 |
ret = -EBUSY; |
|
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1212
diff
changeset
|
460 |
printk(KERN_ERR PFX "Requesting master 0 failed.\n"); |
| 220 | 461 |
goto out_return; |
462 |
} |
|
463 |
||
|
1500
ed1a733efbc5
Improved the callback mechanism.
Florian Pose <fp@igh-essen.com>
parents:
1378
diff
changeset
|
464 |
init_MUTEX(&master_sem); |
|
1513
60ca68d853b8
Re-added callback data pointer, because it is necessary for some applications.
Florian Pose <fp@igh-essen.com>
parents:
1501
diff
changeset
|
465 |
ecrt_master_callbacks(master, send_callback, receive_callback, master); |
| 220 | 466 |
|
|
612
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
467 |
printk(KERN_INFO PFX "Registering domain...\n"); |
|
509
87baea61d0c7
Adjusted examples to 1.2.0 interface changes.
Florian Pose <fp@igh-essen.com>
parents:
472
diff
changeset
|
468 |
if (!(domain1 = ecrt_master_create_domain(master))) {
|
|
612
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
469 |
printk(KERN_ERR PFX "Domain creation failed!\n"); |
|
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
470 |
goto out_release_master; |
|
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
471 |
} |
|
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
472 |
|
| 1567 | 473 |
// Create configuration for bus coupler |
474 |
sc = ecrt_master_slave_config(master, BusCouplerPos, Beckhoff_EK1100); |
|
475 |
if (!sc) |
|
476 |
return -1; |
|
477 |
||
478 |
if (!(sc = ecrt_master_slave_config( |
|
479 |
master, SerialPos, Beckhoff_EL6002))) {
|
|
|
1022
8e49b519e6ba
Implemented ecrt_slave_config_state(); minor changes in
Florian Pose <fp@igh-essen.com>
parents:
909
diff
changeset
|
480 |
printk(KERN_ERR PFX "Failed to get slave configuration.\n"); |
| 1567 | 481 |
return -1; |
482 |
} |
|
483 |
||
484 |
printk("Configuring PDOs...\n");
|
|
485 |
if (ecrt_slave_config_pdos(sc, EC_END, slave_1_syncs)) {
|
|
|
1327
4d179b06dd3c
merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms.
Florian Pose <fp@igh-essen.com>
parents:
1326
diff
changeset
|
486 |
printk(KERN_ERR PFX "Failed to configure PDOs.\n"); |
| 1567 | 487 |
return -1; |
488 |
} |
|
489 |
||
|
792
3778920f61e4
Implemented most realtime interface changes for version 1.4, improved
Florian Pose <fp@igh-essen.com>
parents:
654
diff
changeset
|
490 |
if (ecrt_domain_reg_pdo_entry_list(domain1, domain1_regs)) {
|
|
1327
4d179b06dd3c
merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms.
Florian Pose <fp@igh-essen.com>
parents:
1326
diff
changeset
|
491 |
printk(KERN_ERR PFX "PDO entry registration failed!\n"); |
| 1567 | 492 |
return -1; |
493 |
} |
|
| 809 | 494 |
|
|
612
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
495 |
printk(KERN_INFO PFX "Activating master...\n"); |
| 220 | 496 |
if (ecrt_master_activate(master)) {
|
|
612
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
497 |
printk(KERN_ERR PFX "Failed to activate master!\n"); |
| 809 | 498 |
goto out_release_master; |
| 1567 | 499 |
} |
500 |
||
| 809 | 501 |
// Get internal process data for domain |
| 820 | 502 |
domain1_pd = ecrt_domain_data(domain1); |
|
612
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
503 |
|
|
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
504 |
printk(KERN_INFO PFX "Starting cyclic sample thread.\n"); |
| 220 | 505 |
init_timer(&timer); |
| 820 | 506 |
timer.function = cyclic_task; |
| 220 | 507 |
timer.expires = jiffies + 10; |
508 |
add_timer(&timer); |
|
509 |
||
|
612
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
510 |
printk(KERN_INFO PFX "Started.\n"); |
| 220 | 511 |
return 0; |
512 |
||
| 809 | 513 |
out_release_master: |
|
654
8278e1e27010
Minor changes in minimal example.
Florian Pose <fp@igh-essen.com>
parents:
643
diff
changeset
|
514 |
printk(KERN_ERR PFX "Releasing master...\n"); |
| 220 | 515 |
ecrt_release_master(master); |
| 809 | 516 |
out_return: |
|
654
8278e1e27010
Minor changes in minimal example.
Florian Pose <fp@igh-essen.com>
parents:
643
diff
changeset
|
517 |
printk(KERN_ERR PFX "Failed to load. Aborting.\n"); |
|
1239
b50b93faaf3e
Used ERR_PTR() macro for return value of ecrt_request_master().
Florian Pose <fp@igh-essen.com>
parents:
1212
diff
changeset
|
518 |
return ret; |
| 220 | 519 |
} |
520 |
||
521 |
/*****************************************************************************/ |
|
522 |
||
523 |
void __exit cleanup_mini_module(void) |
|
524 |
{
|
|
|
612
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
525 |
printk(KERN_INFO PFX "Stopping...\n"); |
| 220 | 526 |
|
|
449
3caf8ff4d8a2
Moved functionality of ecrt_master_deactivate() (now deprecated) to ecrt_master_release().
Florian Pose <fp@igh-essen.com>
parents:
446
diff
changeset
|
527 |
del_timer_sync(&timer); |
| 809 | 528 |
|
|
612
aede068f9a74
Introduced master status, ecrt_master_get_status(), tainted flag,
Florian Pose <fp@igh-essen.com>
parents:
551
diff
changeset
|
529 |
printk(KERN_INFO PFX "Releasing master...\n"); |
|
449
3caf8ff4d8a2
Moved functionality of ecrt_master_deactivate() (now deprecated) to ecrt_master_release().
Florian Pose <fp@igh-essen.com>
parents:
446
diff
changeset
|
530 |
ecrt_release_master(master); |
| 220 | 531 |
|
|
654
8278e1e27010
Minor changes in minimal example.
Florian Pose <fp@igh-essen.com>
parents:
643
diff
changeset
|
532 |
printk(KERN_INFO PFX "Unloading.\n"); |
| 220 | 533 |
} |
534 |
||
535 |
/*****************************************************************************/ |
|
536 |
||
537 |
MODULE_LICENSE("GPL");
|
|
|
512
24292123d174
Shorter critical sections in examples.
Florian Pose <fp@igh-essen.com>
parents:
509
diff
changeset
|
538 |
MODULE_AUTHOR("Florian Pose <fp@igh-essen.com>");
|
|
24292123d174
Shorter critical sections in examples.
Florian Pose <fp@igh-essen.com>
parents:
509
diff
changeset
|
539 |
MODULE_DESCRIPTION("EtherCAT minimal test environment");
|
| 220 | 540 |
|
541 |
module_init(init_mini_module); |
|
542 |
module_exit(cleanup_mini_module); |
|
543 |
||
544 |
/*****************************************************************************/ |