Add delay possibility for lx200 driver pulse command, and have the ge… (

indilib#1788)
ourskyai · Dec 16, 2022 · f743772 · f743772
1 parent ce2aef3
commit f743772
Show file tree

Hide file tree

Showing 4 changed files with 14 additions and 2 deletions.
diff --git a/drivers/telescope/lx200driver.cpp b/drivers/telescope/lx200driver.cpp
@@ -1650,7 +1650,7 @@ int MoveTo(int fd, int direction)
     return 0;
 }
 
-int SendPulseCmd(int fd, int direction, int duration_msec)
+int SendPulseCmd(int fd, int direction, int duration_msec, bool wait_after_command, int max_wait_ms)
 {
     DEBUGFDEVICE(lx200Name, DBG_SCOPE, "<%s>", __FUNCTION__);
     int nbytes_write = 0;
@@ -1691,6 +1691,10 @@ int SendPulseCmd(int fd, int direction, int duration_msec)
     tty_write_string(fd, cmd, &nbytes_write);
 
     tcflush(fd, TCIFLUSH);
+
+    if(wait_after_command){
+        usleep((duration_msec>max_wait_ms) ? max_wait_ms*1000 : duration_msec*1000);
+    }
     return 0;
 }
 

diff --git a/drivers/telescope/lx200driver.h b/drivers/telescope/lx200driver.h
@@ -298,7 +298,7 @@ int selectTrackingMode(int fd, int trackMode);
 /* Is Slew complete? 0 if complete, 1 if in progress, otherwise return an error */
 int isSlewComplete(int fd);
 /* Send Pulse-Guide command (timed guide move), two valid directions can be stacked */
-int SendPulseCmd(int fd, int direction, int duration_msec);
+int SendPulseCmd(int fd, int direction, int duration_msec, bool wait_after_command=false, int max_wait_ms=1000);
 
 /**************************************************************************
  Other Commands

diff --git a/drivers/telescope/lx200gemini.cpp b/drivers/telescope/lx200gemini.cpp
@@ -1527,6 +1527,11 @@ bool LX200Gemini::getGeminiProperty(uint32_t propertyNumber, char* value)
     return true;
 }
 
+int LX200Gemini::SendPulseCmd(int8_t direction, uint32_t duration_msec)
+{
+    return ::SendPulseCmd(PortFD, direction, duration_msec, true, 1000);
+}
+
 bool LX200Gemini::setGeminiProperty(uint32_t propertyNumber, char* value)
 {
     int rc = TTY_OK;

diff --git a/drivers/telescope/lx200gemini.h b/drivers/telescope/lx200gemini.h
@@ -60,6 +60,9 @@ class LX200Gemini : public LX200Generic
 
         virtual bool saveConfigItems(FILE *fp) override;
 
+          // Guide Pulse Commands
+        virtual int SendPulseCmd(int8_t direction, uint32_t duration_msec) override;
+
     private:
         void syncPec();
         void syncSideOfPier();