aboutsummaryrefslogtreecommitdiffstats
path: root/System/test_Return_Home.py
blob: 04e19cb139ef34710d73a4b8fb02cb4f97c9c7db (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
from system import System
from time import sleep
        
# Main program
#print("before system()call")
sys = System()
#print("after system() call")
sys.initialize()
#print("after sys.inintalize called")

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()