CourseDetector.h

Go to the documentation of this file.

 
#ifndef _COURSE_DETECTOR_H
#define _COURSE_DETECTOR_H
 
#include <Arduino.h>
#include "DovesLapTimer.h"
#include "GeoMath.h"
 
struct CourseInfo {
  const char* name;
  float lengthFt;
};
 
struct DetectionCandidate {
  int index;
  float ratio;   // distance match quality (0.0 = perfect)
};
 
class CourseDetector {
public:
  CourseDetector();
  void init(CourseInfo* courses, int count);
  void update(double lat, double lng, float speedKmh, float totalOdometer);
  void acceptCandidate(int index);
  // currentOdometer advances the waypoint's lap-window start so the next
  // ranking pass requires another full lap, rather than immediately
  // re-ranking while still in proximity.
  void rejectAllCandidates(float currentOdometer);
  void reset();
  void setSpeedThresholdMph(float mph);
  void setDetectionProximityMeters(float meters);
 
  // Getters
  int getState() const;
  int getDetectedCourseIndex() const;
  bool isDetected() const;
  double getWaypointLat() const;
  double getWaypointLng() const;
  bool hasWaypoint() const;
  int getRankedMatchCount() const;
  const DetectionCandidate* getRankedMatches() const;
  // Completed proximity passes (full laps back at the waypoint) that matched
  // no configured course. CourseManager uses this to reach the Lap Anything
  // fallback even when the detector never produces candidates to reject.
  int getNoMatchCount() const;
 
private:
  void _checkSpeedThreshold(double lat, double lng, float speedKmh, float totalOdometer);
  void _checkWaypointProximity(double lat, double lng, float totalOdometer);
  void _matchCourseRanked(float distanceMeters);
 
  CourseInfo _courses[MAX_COURSES];
  int _courseCount;
  int _state;
  double _waypointLat;
  double _waypointLng;
  float _waypointOdometer;
  int _detectedCourseIndex;
  DetectionCandidate _rankedMatches[MAX_COURSES];
  int _rankedMatchCount;
  int _noMatchCount;
  float _speedThresholdMph;
  float _detectionProximityMeters;
};
 
#endif