Falafel.py 文件源码

def findDistance(TP):
    #this function finds the distance from the reflector    FIX
    FPw = img.shape[1]
    FMw = TMw * FPw / TP[1]
    #print FMw, TMw, FPw, TP[1]
    distw = (FMw / 2) * math.tan(math.radians(TAN_ANGLE_HORI))

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

    dist = (distw + disth)
    #dist = disth * 8
    return dist