1 files changed, 16 insertions, 0 deletions
diff --git a/System/test_Return_Home.py b/System/test_Return_Home.py
new file mode 100644
index 0000000..244f99f
--- /dev/null
+++ b/System/test_Return_Home.py
@@ -0,0 +1,16 @@
+from system import System
+from time import sleep
+        
+# Main program
+sys = System()
+sys.initialize()
+
+ang,lin = sys.measure()
+print("Starting position before moving: " + str(lin))
+sys.adjust(4)
+ang,lin = sys.measure()
+sleep(0.01)
+while lin < 10:
+    ang,lin = sys.measure()
+    sleep(0.01)
+sys.return_home()