frc971/input/driver_station_data.h

#ifndef AOS_INPUT_DRIVER_STATION_DATA_H_
#define AOS_INPUT_DRIVER_STATION_DATA_H_

// This file defines several types to support nicely looking at the data
// received from the driver's station.

#include <array>
#include <memory>

#include "frc971/input/joystick_state_generated.h"

namespace frc971 {
namespace input {
namespace driver_station {

// Represents a feature of a joystick (a button or an axis).
// All indices are 1-based.
class JoystickFeature {
 public:
  JoystickFeature(int joystick, int number)
      : joystick_(joystick), number_(number) {}

  // How many joysticks there are.
  static const int kJoysticks = 6;

  // Which joystick number this is (1-based).
  int joystick() const { return joystick_; }
  // Which feature on joystick() this is (1-based).
  int number() const { return number_; }

 private:
  const int joystick_, number_;
};

// Represents the location of a button.
// Use Data to actually get the value.
// Safe for static initialization.
class ButtonLocation : public JoystickFeature {
 public:
  ButtonLocation(int joystick, int number)
      : JoystickFeature(joystick, number) {}

  // How many buttons there are available on each joystick.
  static const int kButtons = 16;
};

// Represents the direction of a POV on a joystick.
// Use Data to actually get the value.
// Safe for static initialization.
class POVLocation : public JoystickFeature {
 public:
  POVLocation(int joystick, int number) : JoystickFeature(joystick, number) {}
};

// Represents various bits of control information that the DS sends.
// Use Data to actually get the value.
enum class ControlBit { kTestMode, kFmsAttached, kAutonomous, kEnabled };

// Represents a single axis of a joystick.
// Use Data to actually get the value.
// Safe for static initialization.
class JoystickAxis : public JoystickFeature {
 public:
  JoystickAxis(int joystick, int number) : JoystickFeature(joystick, number) {}

  // How many axes there are available on each joystick.
  static const int kAxes = 6;
};

class Data {
 public:
  // Initializes the data to all buttons and control bits off and all joysticks
  // at 0.
  Data();

  // Updates the current information with a new set of values.
  void Update(const aos::JoystickState *new_values);

  bool IsPressed(POVLocation location) const;
  bool PosEdge(POVLocation location) const;
  bool NegEdge(POVLocation location) const;

  // Returns the current and previous "values" for the POV.
  int32_t GetPOV(int joystick) const;
  int32_t GetOldPOV(int joystick) const;

  bool IsPressed(ButtonLocation location) const;
  bool PosEdge(ButtonLocation location) const;
  bool NegEdge(ButtonLocation location) const;

  bool GetControlBit(ControlBit bit) const;
  bool PosEdge(ControlBit bit) const;
  bool NegEdge(ControlBit bit) const;

  // Returns the value in the range [-1.0, 1.0].
  float GetAxis(JoystickAxis axis) const;

 private:
  struct SavedJoystickState {
    struct SavedJoystick {
      uint16_t buttons = 0;
      std::array<double, JoystickAxis::kAxes> axis;
      int pov = 0;
    };

    std::array<SavedJoystick, JoystickFeature::kJoysticks> joysticks;
    bool test_mode = false;
    bool fms_attached = false;
    bool enabled = false;
    bool autonomous = false;
    uint16_t team_id = 0;

    // 2018 scale and switch positions.
    bool switch_left = false;
    bool scale_left = false;
  };

  static bool GetButton(const ButtonLocation location,
                        const Data::SavedJoystickState &values);
  static bool DoGetPOV(const POVLocation location,
                       const Data::SavedJoystickState &values);

  static bool GetControlBitValue(const ControlBit bit,
                                 const Data::SavedJoystickState &values);

  SavedJoystickState current_values_, old_values_;
};

}  // namespace driver_station
}  // namespace input
}  // namespace frc971

#endif  // AOS_INPUT_DRIVER_STATION_DATA_H_