RobotToWorldConverter.h

#pragma once
#include <frc/geometry/Pose2d.h>
 
namespace valor {
class RobotToWorldConverter {
    static constexpr frc::Pose2d RobotToWorld(const frc::Pose2d robot, const frc::Pose2d robotReference) {
        return robotReference.RelativeTo(robot);
    }
 
    static constexpr frc::Pose2d WorldToRobot(const frc::Pose2d robot, const frc::Pose2d worldReference) {
        return worldReference.RelativeTo(robot);
    }
};
}  // namespace valor