forked from Telos4/RoboRally
fixed error with turn around command
This commit is contained in:
parent
3ab8fadc7b
commit
056d91da52
|
@ -244,7 +244,7 @@ class ArucoEstimator:
|
|||
if orientation == '>':
|
||||
angle = y_frac * angle_ab + (1 - y_frac) * angle_dc
|
||||
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':
|
||||
angle = x_frac * angle_ad + (1 - x_frac) * angle_bc
|
||||
elif orientation == '^':
|
||||
|
|
Loading…
Reference in New Issue
Block a user