001package com.stuypulse.robot.util.swerve;
002
003import edu.wpi.first.math.geometry.Pose2d;
004import edu.wpi.first.math.geometry.Rotation2d;
005
006public class AlignmentUtil {
007    public static Rotation2d getTargetAlignmentAngle(Pose2d currentPose, Pose2d targetPose) {
008        double atan = Math.atan2(targetPose.getY() - currentPose.getY(), targetPose.getX() - currentPose.getX());
009        return new Rotation2d((atan));
010    }
011}