fixed error with turn around command

This commit is contained in:
Simon Pirkelmann 2020-10-18 16:58:32 +02:00
parent 3ab8fadc7b
commit 056d91da52

View File

@ -244,7 +244,7 @@ class ArucoEstimator:
if orientation == '>': if orientation == '>':
angle = y_frac * angle_ab + (1 - y_frac) * angle_dc angle = y_frac * angle_ab + (1 - y_frac) * angle_dc
elif orientation == '<': elif orientation == '<':
angle = - (y_frac * angle_ab + (1 - y_frac) * angle_dc) angle = y_frac * angle_ab + (1 - y_frac) * angle_dc + np.pi
elif orientation == 'v': elif orientation == 'v':
angle = x_frac * angle_ad + (1 - x_frac) * angle_bc angle = x_frac * angle_ad + (1 - x_frac) * angle_bc
elif orientation == '^': elif orientation == '^':