AngularPositionController.h

 
#pragma once
 
#include <memory>
 
#include <units/angle.h>
#include <units/angular_velocity.h>
#include <units/length.h>
#include <units/math.h>
 
namespace rmb {
 
class LinearPositionController;
 
class AngularPositionController {
public:
  virtual ~AngularPositionController() = default;
 
  virtual void setPosition(units::radian_t position) = 0;
 
  virtual units::radian_t getTargetPosition() const = 0;
 
  virtual void setPower(double power) = 0;
 
  virtual double getPower() const = 0;
 
  virtual units::radian_t getMinPosition() const = 0;
 
  virtual units::radian_t getMaxPosition() const = 0;
 
  virtual void disable() = 0;
 
  virtual void stop() = 0;
 
  virtual units::radians_per_second_t getVelocity() const = 0;
 
  virtual units::radian_t getPosition() const = 0;
 
  virtual void setEncoderPosition(units::radian_t position = 0_rad) = 0;
 
  virtual units::radian_t getTolerance() const = 0;
 
  virtual units::radian_t getError() const {
    return getPosition() - getTargetPosition();
  }
 
  virtual bool atTarget() const {
    return units::math::abs(getError()) < getTolerance();
  }
 
  using ConversionUnit =
      units::compound_unit<units::meters, units::inverse<units::radians>>;
  using ConversionUnit_t = units::unit_t<ConversionUnit>;
};
 
std::unique_ptr<LinearPositionController>
asLinear(std::unique_ptr<AngularPositionController> angularController,
         AngularPositionController::ConversionUnit_t conversion);
 
} // namespace rmb