ramsete.hpp

Go to the documentation of this file.

#pragma once
 
#include <functional>
#include <vector>
 
#include "LightLib/path/trajectory.hpp"
 
namespace light {
 
struct PathEvent {
  int atWaypoint = 0;            
  std::function<void()> action;  
};
 
struct RamseteConfig {
  float b = 2.0f;          
  float zeta = 0.7f;       
  float trackWidthIn = 12.0f; 
  float wheelDiamIn = 3.25f;  
  float gearRatio = 0.75f; 
};
 
struct DriveFF {
  float kS = 0.0f;  
  float kV = 0.0f;  
  float kA = 0.0f;  
  float kP = 0.0f;  
};
 
void ramsete_configure(RamseteConfig rc, DriveFF ff, TrajConstraints defaultCons);
 
bool followTrajectory(const Trajectory& traj,
                      int timeoutMs = -1,
                      float poseErrBailIn = 8.0f);
 
bool followTrajectory(const std::vector<Waypoint>& wps,
                      const TrajConstraints& cons,
                      bool reversed = false,
                      int timeoutMs = -1,
                      float poseErrBailIn = 8.0f);
 
bool followTrajectory(const std::vector<Waypoint>& wps,
                      const TrajConstraints& cons,
                      std::vector<PathEvent> events,
                      bool reversed = false,
                      int timeoutMs = -1,
                      float poseErrBailIn = 8.0f);
 
bool runJerryioPath(const char* csv,
                    bool reversed = false,
                    int timeoutMs = -1,
                    float poseErrBailIn = 8.0f);
 
bool runJerryioPath(const char* csv,
                    std::vector<PathEvent> events,
                    bool reversed = false,
                    int timeoutMs = -1,
                    float poseErrBailIn = 8.0f);
 
bool runJerryioPathFromSD(const char* filePath,
                          bool reversed = false,
                          int timeoutMs = -1,
                          float poseErrBailIn = 8.0f);
 
bool runJerryioPathFromSD(const char* filePath,
                          std::vector<PathEvent> events,
                          bool reversed = false,
                          int timeoutMs = -1,
                          float poseErrBailIn = 8.0f);
 
void characterize_kV_kA_kS(float maxVoltage = 10.0f, float rampVps = 0.25f);
 
float characterize_track_width(int rotations = 10);
 
float characterize_a_lat_max();
 
void characterize_friction(float maxVoltage = 10.0f, float stepV = 0.5f);
void autotune_turn_pid(float reliefV = 4.0f, int cycles = 6, int timeoutMs = 15000,
                       int chunkCycles = 2, int coolMs = 5000);
void autotune_drive_pid(float reliefV = 6.0f, int cycles = 5, int timeoutMs = 15000,
                        int chunkCycles = 2, int coolMs = 5000);
void autotune_swing_pid(float reliefV = 4.0f, int cycles = 6, int timeoutMs = 15000,
                        int chunkCycles = 2, int coolMs = 5000);
void autotune_heading_pid(float forwardV = 3.0f, float reliefV = 2.0f,
                          int cycles = 5, int timeoutMs = 15000,
                          int chunkCycles = 2, int coolMs = 5000);
void autotune_ekf_noise(int sampleMs = 10, int durationMs = 5000, int warmupMs = 500);
 
void autotune_mcl_noise(int sampleMs = 20, int durationMs = 4000, int warmupMs = 300);
 
}  // namespace light