from time import sleep
from pyjuni.robodog import *
from pyjuni.deflib import *
from pyjuni.jkeyevent import *


if __name__ == '__main__':
    robodog = RoboDog()
    jkey = JKeyEvent()  
    robodog.Open()
    sleep(0.5)
    robodog.move(50)
    while not jkey.isKeyEscPressed():
        distance = robodog.get_distance()
        velocity = 0
        if distance > 50 : 
            velocity = 80
        elif distance > 30 : 
            velocity = 80-(50-distance)*4
        elif distance < 5 : 
            velocity = -80
        elif distance < 25 : 
            velocity = (distance-5)*4 - 80
        robodog.move(velocity)
        sleep(0.1)

    robodog.Close()