WaypointLapTimer.h

Go to the documentation of this file.

 
#ifndef _WAYPOINT_LAP_TIMER_H
#define _WAYPOINT_LAP_TIMER_H
 
#include <Arduino.h>
#include "DovesLapTimer.h"
#include "GeoMath.h"
 
// Internal states
#define WLT_STATE_IDLE           0
#define WLT_STATE_WAITING_SPEED  1
#define WLT_STATE_DRIVING        2
#define WLT_STATE_IN_PROXIMITY   3
 
class WaypointLapTimer {
public:
  WaypointLapTimer(Stream *debugSerial = NULL);
 
  void updateCurrentTime(unsigned long currentTimeMilliseconds);
  int loop(double currentLat, double currentLng, float currentAltitudeMeters, float currentSpeedKnots);
  void reset();
  void setSpeedThresholdMph(float mph);
  void setProximityMeters(float meters);
 
  // Timing getters (duck-typed to DovesLapTimer)
  bool getRaceStarted() const;
  bool getCrossing() const;
  int getLaps() const;
  unsigned long getCurrentLapTime() const;
  unsigned long getLastLapTime() const;
  unsigned long getBestLapTime() const;
  float getCurrentLapDistance() const;
  float getTotalDistanceTraveled() const;
  int getBestLapNumber() const;
  float getPaceDifference() const;
  float getCurrentSpeedKmh() const;
  float getCurrentSpeedMph() const;
 
  float getLastLapDistance() const;
  float getBestLapDistance() const;
 
  // Waypoint access
  bool hasWaypoint() const;
  double getWaypointLat() const;
  double getWaypointLng() const;
 
  // Sector getters (not supported, return 0)
  int getCurrentSector() const { return 0; }
  bool areSectorLinesConfigured() const { return false; }
  unsigned long getCurrentLapSector1Time() const { return 0; }
  unsigned long getCurrentLapSector2Time() const { return 0; }
  unsigned long getCurrentLapSector3Time() const { return 0; }
  unsigned long getBestSector1Time() const { return 0; }
  unsigned long getBestSector2Time() const { return 0; }
  unsigned long getBestSector3Time() const { return 0; }
  unsigned long getOptimalLapTime() const { return 0; }
  int getBestSector1LapNumber() const { return 0; }
  int getBestSector2LapNumber() const { return 0; }
  int getBestSector3LapNumber() const { return 0; }
 
  // Direction (not applicable)
  int getDirection() const { return DIR_UNKNOWN; }
  bool isDirectionResolved() const { return false; }
 
private:
#ifdef DOVES_DISABLE_DEBUG
  // Compile-time debug kill switch: the runtime _serial null-check still
  // keeps every debug string and print call-site in flash on production
  // builds that never attach a debug Stream. Defining DOVES_DISABLE_DEBUG
  // (e.g. -DDOVES_DISABLE_DEBUG in build flags) replaces the debug
  // templates with empty inlines so the compiler drops it all — several
  // KB on a fully-featured firmware. Debug behavior is unchanged when
  // the macro is not defined.
  template<typename... Args> void debug_print(Args&&...) {}
  template<typename... Args> void debug_println(Args&&...) {}
#else
  template<typename... Args>
  void debug_print(Args&&... args) {
    if(_serial) { _serial->print(std::forward<Args>(args)...); }
  }
  template<typename... Args>
  void debug_println(Args&&... args) {
    if(_serial) { _serial->println(std::forward<Args>(args)...); }
  }
#endif
 
  void _resetState();
  void _checkSpeed(double lat, double lng);
  void _checkProximity(double lat, double lng);
  void _updateProximity(double lat, double lng);
  void _resetClosestApproach();
  void _finalizeProximityPass();
 
  Stream *_serial;
 
  int _state;
  unsigned long _millisecondsSinceMidnight;
 
  // Waypoint
  double _waypointLat;
  double _waypointLng;
  float _waypointOdometer;
 
  // Odometer / position
  float _totalDistanceTraveled;
  double _positionPrevLat;
  double _positionPrevLng;
  bool _firstPositionReceived;
  int _consecutiveJumpCount;
  float _currentSpeedKmh;
  float _speedThresholdMph;
  float _proximityMeters;
 
  // Timing
  bool _raceStarted;
  bool _crossing;
  unsigned long _currentLapStartTime;
  unsigned long _lastLapTime;
  unsigned long _bestLapTime;
  float _currentLapOdometerStart;
  float _lastLapDistance;
  float _bestLapDistance;
  int _bestLapNumber;
  int _laps;
 
  // Closest approach to the waypoint during the current proximity pass.
  // Only these three scalars are needed for the lap split — the old
  // 50-entry buffer of every in-proximity fix was written and never read
  // (1.6 KB of dead SRAM per instance).
  float _closestDist;
  unsigned long _closestTime;
  float _closestOdometer;
};
 
#endif