import time
time.sleep(0.1) # Wait for USB to become ready
from machine import Pin, PWM
print("Hello, Pi Pico!")
r_sens = Pin(22, Pin.IN)
l_sens = Pin(7, Pin.IN)
left_speed = PWM(Pin(15))
right_speed = PWM(Pin(16))
left_speed.freq(50)
right_speed.freq(50)

while True:
    time.sleep(0.1)
    if r_sens.value() == 1 and l_sens.value() == 1: 
        left_speed.duty_u16(1500)
        right_speed.duty_u16(1500)
    elif r_sens.value() == 0 and l_sens.value() == 0: 
        left_speed.duty_u16(2000)
        right_speed.duty_u16(2000)
    elif r_sens.value() == 1:
        left_speed.duty_u16(1500)
        right_speed.duty_u16(3500)
    else :
        left_speed.duty_u16(3500)
        right_speed.duty_u16(1500)