from gpiozero import Robot, LED, DistanceSensor
from time import sleep

enable_l = 18
enable_r = 13
left = (12, 16)
right = (23, 24)

#enable_l_object = PWMOutputDevice(enable_l)
#enable_r_object = PWMOutputDevice(enable_r)

#enable_l_object.value(0.1)
#enable_r_object.value(0.1)

enable_l_object = LED(enable_l)
enable_r_object = LED(enable_r)

test_LED = LED(1)

enable_l_object.on()
enable_r_object.on()

robot = Robot(left=left, right=right)

sensor = DistanceSensor(echo=21, trigger=20)

while True:
    x = sensor.distance
    if (x<0.2):
        test_LED.on()
    else:
        test_LED.off()