fixed error with turn around command
This commit is contained in:
parent
3ab8fadc7b
commit
056d91da52
|
@ -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 == '^':
|
||||||
|
|
Loading…
Reference in New Issue
Block a user