Changeset 2517 for trunk/MagicSoft/Cosy/tcpip/MDriveCom.cc

Timestamp:

11/17/03 13:40:14 (21 years ago)

Author:

tbretz

Message:

*** empty log message ***

File:

• trunk/MagicSoft/Cosy/tcpip/MDriveCom.cc (modified) (1 diff)

trunk/MagicSoft/Cosy/tcpip/MDriveCom.cc

@@ -5 +5 @@
 #include "coord.h"
 #include "Slalib.h"
+#include "MCosy.h"
 
 using namespace std;
 
+bool MDriveCom::ReadAngle(TString &str, Double_t &ret)
+{
+    Char_t  sgn;
+    Int_t   d, len;
+    UInt_t  m;
+    Float_t s;
+
+    // Skip whitespaces before %c and after %f
+    int n=sscanf(str.Data(), " %c %d %d %f %n", &sgn, &d, &m, &s, &len);
+
+    if (n!=4 || (sgn!='+' && sgn!='-'))
+        return false;
+
+    str.Remove(0, len);
+
+    ret = Slalib::Dms2Deg(d, m, s, sgn);
+    return true;
+}
+
+bool MDriveCom::ReadPosition(TString &str, Double_t &d1, Double_t &d2)
+{
+    if (!ReadAngle(str, d1))
+        return false;
+
+    if (!ReadAngle(str, d2))
+        return false;
+
+    return true;
+}
+
+bool MDriveCom::CommandRADEC(TString &str)
+{
+    Double_t ra, dec;
+    if (!ReadPosition(str, ra, dec))
+    {
+        cout << "ERROR - Reading position from RADEC" << endl;
+        return false;
+    }
+    if (!str.IsNull())
+    {
+        cout << "ERROR - Too many bytes in command RADEC" << endl;
+        return false;
+    }
+
+    cout << "CC-COMMAND: Track " << ra << "h " << dec << "deg '" << str << "'" << endl;
+
+    ra *= 15; // h -> deg
+
+    RaDec rd[2] = { RaDec(ra, dec), RaDec(ra, dec) };
+
+    cout << "MDriveCom - TRACK... start." << endl;
+    fQueue->PostMsg(WM_TRACK, &rd, sizeof(rd));
+    cout << "MDriveCom - TRACK... done." << endl;
+    return true;
+}
+
+bool MDriveCom::CommandZDAZ(TString &str)
+{
+    Double_t zd, az;
+    if (!ReadPosition(str, zd, az))
+    {
+        cout << "ERROR - Reading position from ZDAZ" << endl;
+        return false;
+    }
+
+    if (!str.IsNull())
+    {
+        cout << "ERROR - Too many bytes in command ZDAZ" << endl;
+        return false;
+    }
+
+    cout << "CC-COMMAND: Move " << zd << "deg " << az << "deg" << endl;
+
+    ZdAz za(zd, az);
+
+    cout << "MDriveCom - POSITION... start." << endl;
+    fQueue->PostMsg(WM_POSITION, &za, sizeof(za));
+    cout << "MDriveCom - POSITION... done." << endl;
+    return true;
+}
+
 bool MDriveCom::InterpreteCmd(TString cmd, TString str)
 {
-    if (cmd==(TString)"STOP!")
+    if (cmd==(TString)"WAIT" && str.IsNull())
     {
-        cout << "Stop! " << str << endl;
+        cout << "MDriveCom - WAIT... start." << endl;
+        fQueue->PostMsg(WM_WAIT);
+        cout << "MDriveCom - WAIT... done." << endl;
+        return true;
+    }
+
+    if (cmd==(TString)"STOP!" && str.IsNull())
+    {
+        cout << "MDriveCom - STOP!... start." << endl;
+        fQueue->PostMsg(WM_STOP);
+        cout << "MDriveCom - STOP!... done." << endl;
         return true;
     }
 
     if (cmd==(TString)"RADEC")
+        return CommandRADEC(str);
+
+    if (cmd==(TString)"ZDAZ")
+        return CommandZDAZ(str);
+
+    if (cmd==(TString)"PREPS")
     {
-        cout << "RaDec: " << str << endl;
+        cout << "Prepos: " << str << endl;
         return true;
     }
-    if (cmd==(TString)"ZDAZ")
+
+    if (cmd.IsNull() && str.IsNull())
     {
-        cout << "ZdAz: " << str << endl;
-        return true;
+        cout << "Empty command (single '\\n') received." << endl;
+        return false;
     }
-    if (cmd==(TString)"PREPS")
-    {
-        cout << "Preposs: " << str << endl;
-        return true;
-    }
-    cout << "Unknown Command: " << cmd << str << endl;
+
+    cout << "Unknown Command: '" << cmd << "':'" << str << "'" << endl;
     return false;
 }