diff --git a/utilities/position.py b/utilities/position.py index c403cf43..d0d45dc4 100644 --- a/utilities/position.py +++ b/utilities/position.py @@ -4,9 +4,9 @@ from utilities.game import ( RED_SPEAKER_POSE, + BLUE_SPEAKER_POSE, field_flip_pose2d, field_flip_translation2d, - get_goal_speaker_position, field_flip_angle, ) @@ -23,7 +23,7 @@ def __init__(self, waypoints: list[Translation2d], face_target: bool): last_waypoint = waypoints[-1] self.final_heading = ( ( - get_goal_speaker_position().toTranslation2d() + BLUE_SPEAKER_POSE.translation().toTranslation2d() - field_flip_translation2d(last_waypoint) ) .angle()