from gpiozero import Servo
from gpiozero import LineSensor
from time import sleep

rightSensor = LineSensor(20)
leftSensor = LineSensor(16)


def leftForward1():
    myGPIO=6
    myCar=Servo(myGPIO)
    for x in range(3):
        sleep(0.01)
        myCar.value = 0.18

def rightForward1():
    myGPIO=13
    myCar=Servo(myGPIO)
    for x in range(3):
        sleep(0.01)
        myCar.value = 0.18


def leftForward():
    myGPIO=6
    myCar=Servo(myGPIO)
    for x in range(4):
        sleep(0.01)
        myCar.value = 0.02

def rightForward():
    myGPIO=13
    myCar=Servo(myGPIO)
    for x in range(4):
        sleep(0.01)
        myCar.value = 0.02




while True:
    right_detect=int(rightSensor.value)
    left_detect=int(leftSensor.value)
    sleep(0.005)
    if (left_detect==1) and (right_detect==1):    #go forward
        leftForward()
        rightForward()
    elif (left_detect==0) and (right_detect==1):
        leftForward1()                                          #making corrections left

        print("Left detected")
    elif (right_detect==0) and (left_detect==1):
        rightForward1()                                           #making corrections right
        print("Right detected")