From cf4b359af63395e5e76da9df9438eb45e332559d Mon Sep 17 00:00:00 2001
From: Agis Zisimatos <azisi@windowslive.com>
Date: Wed, 7 Jan 2015 00:33:31 +0200
Subject: [PATCH] Return position on stop and reset commands.

---
 Arduino/SatNOGS.ino | 12 ++++++++++++
 1 file changed, 12 insertions(+)

diff --git a/Arduino/SatNOGS.ino b/Arduino/SatNOGS.ino
index d19d7ec..8a02ad6 100644
--- a/Arduino/SatNOGS.ino
+++ b/Arduino/SatNOGS.ino
@@ -203,12 +203,24 @@ void cmd_proc(int &stepAz, int &stepEl)
       /* Stop Moving */
       else if (buffer[0] == 'S' && buffer[1] == 'A' && buffer[2] == ' ' && buffer[3] == 'S' && buffer[4] == 'E')
       {
+        /* Get position */
+        Serial.print("AZ");
+        Serial.print(step2deg(AZstepper.currentPosition()), 1);
+        Serial.print(" ");
+        Serial.print("EL");
+        Serial.println(step2deg(ELstepper.currentPosition()), 1);
         stepAz = AZstepper.currentPosition();
         stepEl = ELstepper.currentPosition();
       }
       /* Reset the rotator */
       else if (buffer[0] == 'R' && buffer[1] == 'E' && buffer[2] == 'S' && buffer[3] == 'E' && buffer[4] == 'T')
       {
+        /* Get position */
+        Serial.print("AZ");
+        Serial.print(step2deg(AZstepper.currentPosition()), 1);
+        Serial.print(" ");
+        Serial.print("EL");
+        Serial.println(step2deg(ELstepper.currentPosition()), 1);
         /*Move the steppers to initial position*/
         Homing(0,0);
         /*Zero the steps*/