1 files changed, 17 insertions, 0 deletions
diff --git a/System/test_Return_Home.py b/System/test_Return_Home.py
new file mode 100644
index 0000000..98b291b
--- /dev/null
+++ b/System/test_Return_Home.py
@@ -0,0 +1,17 @@
+from pendulum import System
+from time import sleep
+
+sys = System()
+sys.initialize()
+
+ang,lin = sys.measure()
+
+sys.torque(-100)
+
+ang,lin = sys.measure()
+sleep(0.01)
+while lin > -20:
+    ang,lin = sys.measure()
+    sleep(0.01)
+
+sys.return_home()