Falafel Vision Processing.py 文件源码

def findDistance(TP):
    """
    this function finds the distance from the reflector    FIX
    """

    FPw = img.shape[1]
    FMw = TMw * FPw / TP[1]
    distw = (FMw / 2) * math.tan(math.radians(TAN_ANGLE_HORI))

    FPh = img.shape[0]
    FMh = TMh * FPh / TP[0]
    disth = (FMh / 2) * math.tan(math.radians(TAN_ANGLE_VERT))

    dist = (distw + disth)
    return dist