diff options
Diffstat (limited to '')
-rw-r--r-- | System/test_Return_Home.py | 17 |
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()
|