DistanceCar.hpp

Go to the documentation of this file.

 
#pragma once
 
#include "../../runtime/Runtime.hpp"
#include "../../sensors/odometer/Odometer.hpp"
#include "../simple/SimpleCar.hpp"
 
namespace smartcarlib
{
namespace constants
{
namespace car
{
const unsigned long kDefaultPidFrequency = 80;
const float kDefaultProportional         = 5.0F;
const float kDefaultIntegral             = 0.0F;
const float kDefaultDerivative           = 10.0F;
const int kOdometersNotAttachedError     = -1000;
const auto kBreakSpeedScale              = 10;
} // namespace car
} // namespace constants
} // namespace smartcarlib
 
class DistanceCar : virtual public SimpleCar
{
public:
    DistanceCar(Runtime& runtime, Control& control, Odometer& odometer);
 
    DistanceCar(Runtime& runtime,
                Control& control,
                Odometer& odometerLeft,
                Odometer& odometerRight);
 
    long getDistance();
 
    void setSpeed(float speed) override;
 
    float getSpeed();
 
    void enableCruiseControl(float proportional = smartcarlib::constants::car::kDefaultProportional,
                             float integral     = smartcarlib::constants::car::kDefaultIntegral,
                             float derivative   = smartcarlib::constants::car::kDefaultDerivative,
                             unsigned long frequency
                             = smartcarlib::constants::car::kDefaultPidFrequency);
 
    virtual void update();
 
    void disableCruiseControl();
 
    void overrideMotorSpeed(int firstMotorSpeed, int secondMotorSpeed) override;
 
private:
    Odometer& mOdometerLeft;
    Odometer& mOdometerRight;
    Runtime& mRuntime;
    bool mCruiseControlEnabled{ false };
    float mProportional{ 0 };
    float mIntegral{ 0 };
    float mDerivative{ 0 };
    unsigned long mFrequency{ 0 };
    unsigned long mPreviousUpdate{ 0 };
    float mTargetSpeed{ 0 };
    float mPreviousControlledSpeed{ 0 };
    float mIntegratedError{ 0 };
    float mPreviousError{ 0 };
 
    bool areOdometersAttached() const;
    bool areOdometersDirectional() const;
    float controlMotorSpeed(float previousSpeed, float targetSpeed, float currentSpeed);
 
    void brake();
};