Imaging (m/n) commands: start/stop, masks, image count, n reply

2 files changed, 58 insertions, 0 deletions

diff --git a/mock-server/MockServer.cpp b/mock-server/MockServer.cpp
index f8831da..87279b4 100644
--- a/mock-server/MockServer.cpp
+++ b/mock-server/MockServer.cpp
@@ -185,6 +185,17 @@ MockServer::handleCommand (QTcpSocket *client, const QByteArray &line)
     handleCfJcGetter (client, params);
   else if (cmd == "CF_PH_GETTER")
     handleCfPhGetter (client, params);
+  /* Imaging commands (port 2) */
+  else if (cmd == "m2")
+    handleImagingStart (client, params);
+  else if (cmd == "m4")
+    handleImagingStop (client);
+  else if (cmd == "m0" || cmd == "m5")
+    handleImagingMaskStart (client, cmd, params);
+  else if (cmd == "m1" || cmd == "m6")
+    handleImagingMaskEnd (client, cmd, params);
+  else if (cmd == "m3")
+    handleImageCount (client);
   else
     qWarning ("%s Unknown command: %s",
               qPrintable (logTag (client->localPort ())), cmd.constData ());
@@ -469,3 +480,42 @@ MockServer::sendPhStatusMsg ()
         && client->localPort () == m_status.number)
       sendReply (client, base);
 }
+
+void
+MockServer::handleImagingStart (QTcpSocket *client, const QByteArray &params)
+{
+  qDebug ("%s RX m2,%s", qPrintable (logTag (client->localPort ())),
+          params.constData ());
+  sendReply (client, "n,\"A\"\n");
+}
+
+void
+MockServer::handleImagingStop (QTcpSocket *client)
+{
+  qDebug ("%s RX m4", qPrintable (logTag (client->localPort ())));
+  sendReply (client, "m4,1\n");
+}
+
+void
+MockServer::handleImagingMaskStart (QTcpSocket *client, const QByteArray &cmd,
+                                    const QByteArray &params)
+{
+  qDebug ("%s RX %s,%s", qPrintable (logTag (client->localPort ())),
+          cmd.constData (), params.constData ());
+}
+
+void
+MockServer::handleImagingMaskEnd (QTcpSocket *client, const QByteArray &cmd,
+                                  const QByteArray &params)
+{
+  qDebug ("%s RX %s,%s", qPrintable (logTag (client->localPort ())),
+          cmd.constData (), params.constData ());
+  sendReply (client, "n,\"A\"\n");
+}
+
+void
+MockServer::handleImageCount (QTcpSocket *client)
+{
+  qDebug ("%s RX m3", qPrintable (logTag (client->localPort ())));
+  sendReply (client, "n,\"0\"\n");
+}
diff --git a/mock-server/MockServer.h b/mock-server/MockServer.h
index 3086057..74b2731 100644
--- a/mock-server/MockServer.h
+++ b/mock-server/MockServer.h
@@ -69,6 +69,14 @@ private:
   void handleCfPhSetter (QTcpSocket *client, const QByteArray &params);
   void handleCfJcGetter (QTcpSocket *client, const QByteArray &params);
   void handleCfPhGetter (QTcpSocket *client, const QByteArray &params);
+  /* Imaging command handlers */
+  void handleImagingStart (QTcpSocket *client, const QByteArray &params);
+  void handleImagingStop (QTcpSocket *client);
+  void handleImagingMaskStart (QTcpSocket *client, const QByteArray &cmd,
+                               const QByteArray &params);
+  void handleImagingMaskEnd (QTcpSocket *client, const QByteArray &cmd,
+                             const QByteArray &params);
+  void handleImageCount (QTcpSocket *client);
 
   Port m_command;
   Port m_imaging;