equal
deleted
inserted
replaced
264 pointer */ |
264 pointer */ |
265 ) |
265 ) |
266 { |
266 { |
267 ec_data_reg_t *data_reg; |
267 ec_data_reg_t *data_reg; |
268 ec_sii_sync_t *sync; |
268 ec_sii_sync_t *sync; |
269 unsigned int sync_index; |
|
270 uint16_t sync_length; |
269 uint16_t sync_length; |
271 |
270 |
272 switch (dir) { // FIXME |
271 if (!(sync = ec_slave_get_pdo_sync(slave, dir))) { |
273 case EC_DIR_OUTPUT: sync_index = 2; break; |
|
274 case EC_DIR_INPUT: sync_index = 3; break; |
|
275 default: |
|
276 EC_ERR("Invalid direction!\n"); |
|
277 return -1; |
|
278 } |
|
279 |
|
280 if (sync_index >= slave->sii_sync_count) { |
|
281 EC_ERR("No sync manager found for PDO range.\n"); |
272 EC_ERR("No sync manager found for PDO range.\n"); |
282 return -1; |
273 return -1; |
283 } |
274 } |
284 sync = &slave->sii_syncs[sync_index]; |
|
285 |
275 |
286 // Allocate memory for data registration object |
276 // Allocate memory for data registration object |
287 if (!(data_reg = |
277 if (!(data_reg = |
288 (ec_data_reg_t *) kmalloc(sizeof(ec_data_reg_t), GFP_KERNEL))) { |
278 (ec_data_reg_t *) kmalloc(sizeof(ec_data_reg_t), GFP_KERNEL))) { |
289 EC_ERR("Failed to allocate data registration.\n"); |
279 EC_ERR("Failed to allocate data registration.\n"); |