pose_continuity_fix.h

Go to the documentation of this file.

 
 
#pragma once
 
#include <frc/geometry/Pose2d.h>
#include <frc/geometry/Rotation2d.h>
#include <units/angle.h>
 
units::degree_t GetContinuousOffset(units::degree_t continuousStartRotation,
                                    frc::Rotation2d& startRotation,
                                    units::degree_t continuousEndRotation,
                                    frc::Rotation2d& endRotation);
 
units::degree_t GetContinuousOffset(units::degree_t continuousStartRotation,
                                    frc::Pose2d& startPosition,
                                    units::degree_t continuousEndRotation,
                                    frc::Pose2d& endPosition);