System/test_Return_Home.py


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
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()