resetRobotPose when switching to teleop has some issue. It works when robot in blue alliance, while convert in red alliance