Pose2d,Rotation2d - not rotating to setpoint


Trying to get our robot to follow a path using a List of Pose2d,Rotation2d values. The problem we are experiencing is while we reach the Pose2d values (even if we add setpoints that swerve through a y axis change), we never get to the Rotation2d Values. In the example below, the robot turns to around 45 degrees (as shown by info on the smartdashboard).

new AutoDrive(List.of((new Pose2d(0, 0, new Rotation2d(0))),
//if works try -4
//practice math: -3
(new Pose2d(-1, 0, Rotation2d.fromDegrees(33.0))),
(new Pose2d(-1.5, 0, Rotation2d.fromDegrees(200.0)))),

All code is in github. This sample is in RobotContainer as m_autoRight : 2023-Robot/RobotContainer.java at master · rmeesters/2023-Robot · GitHub

Autodrive code here: https://github.com/rmeesters/2023-Robot/blob/master/src/main/java/frc/robot/autos/AutoDrive.javahttps://github.com/rmeesters/2023-Robot/blob/master/src/main/java/frc/robot/autos/AutoDrive.java

Any thoughts would be most welcome.