odometry_aim.h

Go to the documentation of this file.

 
 
#pragma once
 
#include <frc/geometry/Translation2d.h>
#include <frc/geometry/Translation3d.h>
 
#include "units/angle.h"
#include "units/length.h"
 
namespace argos_lib {
  namespace odometry_aim {
    units::degree_t GetAngleToTarget(const frc::Translation2d& currentEstimatedRobotPose,
                                     const frc::Translation3d& targetPoseOnField);
 
    units::meter_t GetDistanceToTarget(const frc::Translation2d& currentEstimatedRobotPose,
                                       const frc::Translation3d& targetPoseOnField);
  }  // namespace odometry_aim
}  // namespace argos_lib