Add gyro and accelerometer simulator wrappers (#1183)

simulation/lowfi_simulation/src/main/native/include/lowfisim/SimpleGyroSim.h

@@ -0,0 +1,35 @@
+/*----------------------------------------------------------------------------*/
+/* Copyright (c) 2018 FIRST. All Rights Reserved.                             */
+/* Open Source Software - may be modified and shared by FRC teams. The code   */
+/* must be accompanied by the FIRST BSD license file in the root directory of */
+/* the project.                                                               */
+/*----------------------------------------------------------------------------*/
+
+#pragma once
+
+#include <functional>
+
+#include "lowfisim/GyroSim.h"
+
+namespace frc {
+namespace sim {
+namespace lowfi {
+
+class SimpleGyroSim : public GyroSim {
+ public:
+  SimpleGyroSim(std::function<void(double)>& setterFunction,
+                std::function<double(void)>& getterFunction)
+      : m_setAngleFunction(setterFunction),
+        m_getAngleFunction(getterFunction) {}
+  double GetAngle() override { return m_getAngleFunction(); }
+
+  void SetAngle(double angle) override { m_setAngleFunction(angle); }
+
+ private:
+  std::function<void(double)> m_setAngleFunction;
+  std::function<double(void)> m_getAngleFunction;
+};
+
+}  // namespace lowfi
+}  // namespace sim
+}  // namespace frc