commit 40f774d5ce975086f68ea79bec32bfac741767d9
author Maxwell Henderson <maxwell.henderson@mailbox.org> Wed Aug 23 10:55:07 2023 -0700
committer Maxwell Henderson <maxwell.henderson@mailbox.org> Sat Aug 26 08:09:26 2023 -0700
tree a778f68acbbd4dcdfc249ce9733dc20f9a8a1511
parent ec635d2559c61c56bd42b1d36a14732d0bcd50f8

Change falcon position scale by a gear ratio

Signed-off-by: Maxwell Henderson <maxwell.henderson@mailbox.org>
Change-Id: I5965428c19fb51bb1e86086ff56990ab5c71eaee

frc971/wpilib/falcon.cc

diff --git a/frc971/wpilib/falcon.cc b/frc971/wpilib/falcon.cc
index 6be83aa..014556d 100644
--- a/frc971/wpilib/falcon.cc
+++ b/frc971/wpilib/falcon.cc
@@ -94,7 +94,8 @@
   return status;
 }
 
-void Falcon::SerializePosition(flatbuffers::FlatBufferBuilder *fbb) {
+void Falcon::SerializePosition(flatbuffers::FlatBufferBuilder *fbb,
+                               double gear_ratio) {
   control_loops::CANFalcon::Builder builder(*fbb);
   builder.add_id(device_id_);
   builder.add_device_temp(device_temp());
@@ -102,7 +103,7 @@
   builder.add_supply_current(supply_current());
   builder.add_torque_current(torque_current());
   builder.add_duty_cycle(duty_cycle());
-  builder.add_position(position());
+  builder.add_position(position() * gear_ratio);
 
   last_position_offset_ = builder.Finish();
 }