SCRIPT Move cc files

wpilibc/src/main/native/cpp/driverstation/GenericHID.cpp

@@ -0,0 +1,176 @@
+// 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.
+
+#include "frc/GenericHID.h"
+
+#include <string>
+
+#include <hal/DriverStation.h>
+
+#include "frc/DriverStation.h"
+#include "frc/Errors.h"
+#include "frc/event/BooleanEvent.h"
+
+using namespace frc;
+
+GenericHID::GenericHID(int port) {
+  if (port < 0 || port >= DriverStation::kJoystickPorts) {
+    throw FRC_MakeError(warn::BadJoystickIndex, "port {} out of range", port);
+  }
+  m_port = port;
+}
+
+bool GenericHID::GetRawButton(int button) const {
+  return DriverStation::GetStickButton(m_port, button);
+}
+
+bool GenericHID::GetRawButtonPressed(int button) {
+  return DriverStation::GetStickButtonPressed(m_port, button);
+}
+
+bool GenericHID::GetRawButtonReleased(int button) {
+  return DriverStation::GetStickButtonReleased(m_port, button);
+}
+
+BooleanEvent GenericHID::Button(int button, EventLoop* loop) const {
+  return BooleanEvent(loop,
+                      [this, button]() { return this->GetRawButton(button); });
+}
+
+double GenericHID::GetRawAxis(int axis) const {
+  return DriverStation::GetStickAxis(m_port, axis);
+}
+
+DriverStation::POVDirection GenericHID::GetPOV(int pov) const {
+  return DriverStation::GetStickPOV(m_port, pov);
+}
+
+BooleanEvent GenericHID::POV(DriverStation::POVDirection angle,
+                             EventLoop* loop) const {
+  return POV(0, angle, loop);
+}
+
+BooleanEvent GenericHID::POV(int pov, DriverStation::POVDirection angle,
+                             EventLoop* loop) const {
+  return BooleanEvent(
+      loop, [this, pov, angle] { return this->GetPOV(pov) == angle; });
+}
+
+BooleanEvent GenericHID::POVUp(EventLoop* loop) const {
+  return POV(DriverStation::kUp, loop);
+}
+
+BooleanEvent GenericHID::POVUpRight(EventLoop* loop) const {
+  return POV(DriverStation::kUpRight, loop);
+}
+
+BooleanEvent GenericHID::POVRight(EventLoop* loop) const {
+  return POV(DriverStation::kRight, loop);
+}
+
+BooleanEvent GenericHID::POVDownRight(EventLoop* loop) const {
+  return POV(DriverStation::kDownRight, loop);
+}
+
+BooleanEvent GenericHID::POVDown(EventLoop* loop) const {
+  return POV(DriverStation::kDown, loop);
+}
+
+BooleanEvent GenericHID::POVDownLeft(EventLoop* loop) const {
+  return POV(DriverStation::kDownLeft, loop);
+}
+
+BooleanEvent GenericHID::POVLeft(EventLoop* loop) const {
+  return POV(DriverStation::kLeft, loop);
+}
+
+BooleanEvent GenericHID::POVUpLeft(EventLoop* loop) const {
+  return POV(DriverStation::kUpLeft, loop);
+}
+
+BooleanEvent GenericHID::POVCenter(EventLoop* loop) const {
+  return POV(DriverStation::kCenter, loop);
+}
+
+BooleanEvent GenericHID::AxisLessThan(int axis, double threshold,
+                                      EventLoop* loop) const {
+  return BooleanEvent(loop, [this, axis, threshold]() {
+    return this->GetRawAxis(axis) < threshold;
+  });
+}
+
+BooleanEvent GenericHID::AxisGreaterThan(int axis, double threshold,
+                                         EventLoop* loop) const {
+  return BooleanEvent(loop, [this, axis, threshold]() {
+    return this->GetRawAxis(axis) > threshold;
+  });
+}
+
+int GenericHID::GetAxesMaximumIndex() const {
+  return DriverStation::GetStickAxesMaximumIndex(m_port);
+}
+
+int GenericHID::GetAxesAvailable() const {
+  return DriverStation::GetStickAxesAvailable(m_port);
+}
+
+int GenericHID::GetPOVsMaximumIndex() const {
+  return DriverStation::GetStickPOVsMaximumIndex(m_port);
+}
+
+int GenericHID::GetPOVsAvailable() const {
+  return DriverStation::GetStickPOVsAvailable(m_port);
+}
+
+int GenericHID::GetButtonsMaximumIndex() const {
+  return DriverStation::GetStickButtonsMaximumIndex(m_port);
+}
+
+uint64_t GenericHID::GetButtonsAvailable() const {
+  return DriverStation::GetStickButtonsAvailable(m_port);
+}
+
+bool GenericHID::IsConnected() const {
+  return DriverStation::IsJoystickConnected(m_port);
+}
+
+GenericHID::HIDType GenericHID::GetType() const {
+  return static_cast<HIDType>(DriverStation::GetJoystickType(m_port));
+}
+
+std::string GenericHID::GetName() const {
+  return DriverStation::GetJoystickName(m_port);
+}
+
+int GenericHID::GetPort() const {
+  return m_port;
+}
+
+void GenericHID::SetOutput(int outputNumber, bool value) {
+  m_outputs =
+      (m_outputs & ~(1 << (outputNumber - 1))) | (value << (outputNumber - 1));
+
+  HAL_SetJoystickOutputs(m_port, m_outputs, m_leftRumble, m_rightRumble);
+}
+
+void GenericHID::SetOutputs(int value) {
+  m_outputs = value;
+  HAL_SetJoystickOutputs(m_port, m_outputs, m_leftRumble, m_rightRumble);
+}
+
+void GenericHID::SetRumble(RumbleType type, double value) {
+  value = std::clamp(value, 0.0, 1.0);
+  double rumbleValue = value * 65535;
+
+  if (type == kLeftRumble) {
+    m_leftRumble = rumbleValue;
+  } else if (type == kRightRumble) {
+    m_rightRumble = rumbleValue;
+  } else {
+    m_leftRumble = rumbleValue;
+    m_rightRumble = rumbleValue;
+  }
+
+  HAL_SetJoystickOutputs(m_port, m_outputs, m_leftRumble, m_rightRumble);
+}