LinearVelocityController.h

 
#pragma once
 
#include <memory>
 
#include <units/angle.h>
#include <units/length.h>
#include <units/math.h>
#include <units/velocity.h>
 
namespace rmb {
 
class AngularVelocityController;
 
class LinearVelocityController {
public:
  virtual ~LinearVelocityController() = default;
 
  //***************
  // Motor Control
  //***************
 
  virtual void setVelocity(units::meters_per_second_t velocity) = 0;
 
  virtual units::meters_per_second_t getTargetVelocity() const = 0;
 
  virtual void setPower(double power) = 0;
 
  virtual double getPower() const = 0;
 
  virtual void disable() = 0;
 
  virtual void stop() = 0;
 
  virtual units::meters_per_second_t getVelocity() const = 0;
 
  virtual units::meter_t getPosition() const = 0;
 
  virtual void setEncoderPosition(units::meter_t position = 0_m) = 0;
 
  virtual units::meters_per_second_t getTolerance() const = 0;
 
  virtual units::meters_per_second_t getError() const {
    return getVelocity() - getTargetVelocity();
  }
 
  virtual bool atTarget() const {
    return units::math::abs(getError()) < getTolerance();
  }
 
  //*************
  // Conversions
  //*************
 
  using ConversionUnit =
      units::compound_unit<units::meters, units::inverse<units::radians>>;
  using ConversionUnit_t = units::unit_t<ConversionUnit>;
};
 
std::unique_ptr<AngularVelocityController>
asAngular(std::unique_ptr<LinearVelocityController> linearController,
          LinearVelocityController::ConversionUnit_t conversion);
 
} // namespace rmb