XRPServo.hpp

Go to the documentation of this file.

// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.
 
#pragma once
 
#include <map>
#include <set>
#include <string>
 
#include "wpi/hal/SimDevice.hpp"
#include "wpi/units/angle.hpp"
 
namespace wpi::xrp {
 
/**
 * @ingroup xrp_api
 * @{
 */
 
/**
 * XRPServo.
 *
 * <p>A SimDevice based servo
 */
class XRPServo {
 public:
  /**
   * Constructs an XRPServo.
   *
   * @param deviceNum the servo channel
   */
  explicit XRPServo(int deviceNum);
 
  /**
   * Set the servo angle.
   *
   * @param angle Desired angle in radians
   */
  void SetAngle(wpi::units::radian_t angle);
 
  /**
   * Get the servo angle.
   *
   * @return Current servo angle in radians
   */
  wpi::units::radian_t GetAngle() const;
 
 private:
  hal::SimDevice m_simDevice;
  hal::SimDouble m_simPosition;
 
  std::string m_deviceName;
 
  static std::map<int, std::string> s_simDeviceMap;
  static std::set<int> s_registeredDevices;
 
  static void CheckDeviceAllocation(int deviceNum);
};
 
/** @} */
 
}  // namespace wpi::xrp