nt_motor_pid_tuner.h

Go to the documentation of this file.

 
 
#pragma once
 
#include <condition_variable>
#include <initializer_list>
#include <memory>
#include <mutex>
#include <string>
#include <thread>
#include <vector>
 
#include "argos_lib/general/nt_subscriber.h"
#include "ctre/Phoenix.h"
 
namespace argos_lib {
 
  template <class Callable>
  constexpr double GetSensorConversionFactor(Callable toPhysicalUnitsFunction) {
    return toPhysicalUnitsFunction(1.0).template to<double>();
  }
 
  struct ClosedLoopSensorConversions {
    double position{1.0};  
    double velocity{1.0};  
    double setpoint{
        1.0};  
  };
 
  class NTMotorPIDTuner {
   public:
    NTMotorPIDTuner(const std::string& tableName,
                    std::initializer_list<ctre::phoenix::motorcontrol::can::BaseTalon*> motors,
                    uint pidSlot,
                    ClosedLoopSensorConversions sensorConversions = {});
 
    ~NTMotorPIDTuner();
 
   private:
    argos_lib::NTSubscriber
        m_updateSubscriber;  
    const std::vector<ctre::phoenix::motorcontrol::can::BaseTalon*>
        m_pMotors;                                 
    const uint m_pidSlot;                          
    std::shared_ptr<nt::NetworkTable> m_pntTable;  
    ClosedLoopSensorConversions
        m_sensorConversions;  
 
    std::mutex m_threadMutex;                
    std::condition_variable m_threadStopCv;  
    std::thread m_statusUpdateThread;        
 
    void UpdateClosedLoopMonitoringThread();
  };
 
}  // namespace argos_lib