Guess sync manager settings if mailbox information available.
authorFlorian Pose <fp@igh-essen.com>
Fri, 20 Oct 2006 10:05:52 +0000
changeset 420 0ae52c37179b
parent 419 cf724fc82a00
child 421 2b3ce4f51bd6
Guess sync manager settings if mailbox information available.
master/fsm.c
--- a/master/fsm.c	Thu Oct 19 14:23:24 2006 +0000
+++ b/master/fsm.c	Fri Oct 20 10:05:52 2006 +0000
@@ -1387,6 +1387,7 @@
     ec_slave_t *slave = fsm->slave;
     ec_datagram_t *datagram = &fsm->datagram;
     const ec_sii_sync_t *sync;
+    ec_sii_sync_t mbox_sync;
 
     fsm->change_state(fsm); // execute state change state machine
 
@@ -1434,15 +1435,40 @@
                      EC_SYNC_SIZE * slave->base_sync_count);
     memset(datagram->data, 0x00, EC_SYNC_SIZE * slave->base_sync_count);
 
-    list_for_each_entry(sync, &slave->sii_syncs, list) {
-        if (sync->index >= slave->base_sync_count) {
-            EC_ERR("Invalid sync manager configuration found!");
-            fsm->slave->error_flag = 1;
-            fsm->slave_state = ec_fsm_error;
-            return;
-        }
-        ec_sync_config(sync, slave,
-                       datagram->data + EC_SYNC_SIZE * sync->index);
+    if (list_empty(&slave->sii_syncs)) {
+        if (slave->sii_rx_mailbox_offset && slave->sii_tx_mailbox_offset) {
+            if (slave->master->debug_level)
+                EC_DBG("Guessing sync manager settings for slave %i.\n",
+                       slave->ring_position);
+            mbox_sync.index = 0;
+            mbox_sync.physical_start_address = slave->sii_tx_mailbox_offset;
+            mbox_sync.length = slave->sii_tx_mailbox_size;
+            mbox_sync.control_register = 0x26;
+            mbox_sync.enable = 0x01;
+            mbox_sync.est_length = 0;
+            ec_sync_config(&mbox_sync, slave,
+                           datagram->data + EC_SYNC_SIZE * mbox_sync.index);
+            mbox_sync.index = 1;
+            mbox_sync.physical_start_address = slave->sii_rx_mailbox_offset;
+            mbox_sync.length = slave->sii_rx_mailbox_size;
+            mbox_sync.control_register = 0x22;
+            mbox_sync.enable = 0x01;
+            mbox_sync.est_length = 0;
+            ec_sync_config(&mbox_sync, slave,
+                           datagram->data + EC_SYNC_SIZE * mbox_sync.index);
+        }
+    }
+    else {
+        list_for_each_entry(sync, &slave->sii_syncs, list) {
+            if (sync->index >= slave->base_sync_count) {
+                EC_ERR("Invalid sync manager configuration found!");
+                fsm->slave->error_flag = 1;
+                fsm->slave_state = ec_fsm_error;
+                return;
+            }
+            ec_sync_config(sync, slave,
+                           datagram->data + EC_SYNC_SIZE * sync->index);
+        }
     }
 
     ec_master_queue_datagram(fsm->master, datagram);