From a4dc9a7d8a57ed432b7d8b08ddaae4344e5c67cd Mon Sep 17 00:00:00 2001
From: Hakop Zarikyan <hakopzarikyan@gmail.com>
Date: Mon, 6 Jan 2025 00:35:25 -0800
Subject: [PATCH] Added get angle but did not implement it yet. Will do so
 after meeting with jess.

---
 include/EZ-Template/drive/drive.hpp | 4 ++++
 src/EZ-Template/drive/drive.cpp     | 4 ++++
 2 files changed, 8 insertions(+)

diff --git a/include/EZ-Template/drive/drive.hpp b/include/EZ-Template/drive/drive.hpp
index f8aba0f..67b5a07 100644
--- a/include/EZ-Template/drive/drive.hpp
+++ b/include/EZ-Template/drive/drive.hpp
@@ -1411,6 +1411,10 @@ class Drive {
    */
   void drive_imu_display_loading(int iter);
 
+  /**
+   * Get angle of the robot, depending on focused sensor
+   */
+  double get_angle();
   /**
    * Practice mode for driver practice that shuts off the drive if you go max speed.
    *
diff --git a/src/EZ-Template/drive/drive.cpp b/src/EZ-Template/drive/drive.cpp
index c1b8c68..0abedb0 100644
--- a/src/EZ-Template/drive/drive.cpp
+++ b/src/EZ-Template/drive/drive.cpp
@@ -266,6 +266,10 @@ void Drive::drive_defaults_set() {
   as::limit_switch_lcd_initialize(nullptr, nullptr);
 }
 
+double Drive::get_angle()
+{
+  return 0;
+}
 double Drive::drive_tick_per_inch() {
   if (is_tracker == ODOM_TRACKER)
     return odom_tracker_right->ticks_per_inch();