Changeset 2278 for trunk/MagicSoft/Cosy/devdrv/macs.cc

Timestamp:

07/15/03 15:05:21 (21 years ago)

Author:

tbretz

Message:

*** empty log message ***

File:

• trunk/MagicSoft/Cosy/devdrv/macs.cc (modified) (9 diffs)

trunk/MagicSoft/Cosy/devdrv/macs.cc

@@ -127 +127 @@
 }
 
-void Macs::HandleSDOOK(WORD_t idx, BYTE_t subidx, timeval_t *tv)
-{
-//    cout << "Node #" << dec << (int)GetId() << ": Sdo=" << hex << idx  << "/" << (int)subidx << " set." << endl;
+void Macs::HandleSDOOK(WORD_t idx, BYTE_t subidx, LWORD_t data, timeval_t *tv)
+{
+    //    cout << "Node #" << dec << (int)GetId() << ": Sdo=" << hex << idx  << "/" << (int)subidx << " set." << endl;
+
+    // If a real drive operation is requested from the MACS and
+    // the MACS is not correctly initialized the operation is
+    // rejected. (This is expecially harmfull if the NoWait state
+    // is set incorrectly)
+    if (data)
+        SetZombie();
+
     switch (idx)
     {
@@ -201 +209 @@
 
     }
-    NodeDrv::HandleSDOOK(idx, subidx, tv);
+    NodeDrv::HandleSDOOK(idx, subidx, data, tv);
 }
 
@@ -223 +231 @@
     SendSDO(0x1800, 1, (LWORD_t)(flag?0:1)<<31); 
     WaitForSdo(0x1800, 1);           
+}
+
+void Macs::StartNode()
+{
+    //
+    // Switch node from pre-operational state to operational state
+    // (This is not CANOpen compatible)
+    // After this the MACS will react on real movement commands.
+    //
+    lout << "- " << GetNodeName() << ": Starting Node." << endl;
+    SendSDO(0x1000, 1, (LWORD_t)1);
+    WaitForSdo(0x1000, 1);
 }
 
@@ -251 +271 @@
     StopGuarding();
 
-    usleep(2000*GetGuardTime());
+// ****FIXME***   usleep(2000*GetGuardTime());
 
     lout << "- " << GetNodeName() << ": Requesting Mac Software Version." << endl;
@@ -257 +277 @@
     WaitForSdo(0x100a);
     // FIXME! Not statically linked!
-    if (fSoftVersion<0x00000044) // 00.68
+    //if (fSoftVersion<0x00000044) // 00.68
+    if (fSoftVersion<0x00000045) // 00.69
     {
         lout << GetNodeName() << " - Software Version too old!" << endl;
@@ -269 +290 @@
     ReqVelRes(); // Init fVelRes
 
-    lout << "- " << GetNodeName() << ": Motor on." << endl;
-    SendSDO(0x3000, string('o', 'n'));
-    WaitForSdo(0x3000);
+    /* Should not be necessary anymore. This is done by the MACS itself.
+     lout << "- " << GetNodeName() << ": Motor on." << endl;
+     SendSDO(0x3000, string('o', 'n'));
+     WaitForSdo(0x3000);
+     */
 
     SetPDO1On(FALSE); // this is a workaround for the Macs
     SetPDO1On(TRUE);
 
-    SetNoWait(TRUE);
-
-//    StartGuarding(200, 2, kFALSE); // Using PDO1 @ 100ms
-
-//    StartGuarding(250, 4);
-//    StartHostGuarding();
-}
-
+    //This is now standard in the MACS
+    //SetNoWait(TRUE);
+
+    // StartGuarding(200, 2, kFALSE); // Using PDO1 @ 100ms
+    // StartGuarding(250, 4);
+    // StartHostGuarding();
+
+    StartNode();
+}
+/*
 void Macs::StopMotor()
 {
@@ -292 +317 @@
     WaitForSdo(0x3000);
 }
-
+*/
 void Macs::StopDevice()
 {
     //EnableTimeout(kFALSE);
 
-    SetNoWait(FALSE);
+    //No need to switch it off.
+    //SetNoWait(FALSE);
 
     StopHostGuarding();
@@ -402 +428 @@
 }
 
+/*
 void Macs::SetNoWait(BYTE_t flag)
 {
@@ -408 +435 @@
     WaitForSdo(0x3008);
 }
+*/
 
 void Macs::StartVelSync()