From 6e8c893503cac801d930c1785826463204f115e0 Mon Sep 17 00:00:00 2001 From: Matt Strapp Date: Thu, 14 Apr 2022 13:39:18 -0500 Subject: Add new changes from local testing Signed-off-by: Matt Strapp --- System/test_Return_Home.py | 17 +++++++++++++++++ 1 file changed, 17 insertions(+) create mode 100644 System/test_Return_Home.py (limited to 'System/test_Return_Home.py') 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() -- cgit v1.2.3