def getError(self,goal,L,begin,end):
    return goal-(min(L[begin:end]))

#get the angle
def getSteeringCmd(self,error,threshold,fullLeft,fullRight):
    if(abs(error)<threshold):
        return 0
    elif error>0:
        return fullLeft
    else:
        return fullRight