diff options
author | Raspberry Pi <raspberrypi@umn.edu> | 2019-11-19 22:19:55 -0600 |
---|---|---|
committer | Raspberry Pi <raspberrypi@umn.edu> | 2019-11-19 22:19:55 -0600 |
commit | 2e4ab26e749a8ec17f6ab2de10722dd9031a3ae4 (patch) | |
tree | ab93d05b806ec5f8a1ced8c9369b92e6871cb31f /System_Python/test_Return_Home.py | |
parent | Remove leftover files from a past merge. (diff) | |
download | ee4511w-2e4ab26e749a8ec17f6ab2de10722dd9031a3ae4.tar ee4511w-2e4ab26e749a8ec17f6ab2de10722dd9031a3ae4.tar.gz ee4511w-2e4ab26e749a8ec17f6ab2de10722dd9031a3ae4.tar.bz2 ee4511w-2e4ab26e749a8ec17f6ab2de10722dd9031a3ae4.tar.lz ee4511w-2e4ab26e749a8ec17f6ab2de10722dd9031a3ae4.tar.xz ee4511w-2e4ab26e749a8ec17f6ab2de10722dd9031a3ae4.tar.zst ee4511w-2e4ab26e749a8ec17f6ab2de10722dd9031a3ae4.zip |
Fixed encoder zeroing. Other minor changes, still trying to get the swingup controller working. Not sure if the code is good enough to make it happen...
Diffstat (limited to '')
-rw-r--r-- | System_Python/test_Return_Home.py | 16 |
1 files changed, 16 insertions, 0 deletions
diff --git a/System_Python/test_Return_Home.py b/System_Python/test_Return_Home.py new file mode 100644 index 0000000..244f99f --- /dev/null +++ b/System_Python/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()
|