aaron/rover-ros2
1
0
Fork 0
mirror of https://github.com/SHC-ASTRA/rover-ros2.git synced 2026-02-11 09:20:40 +00:00
Code Issues Packages Projects Releases Wiki Activity

Remove /10.0 on heading for core feedback

Browse Source
This commit is contained in:
Tristan McGinnis
2025-05-30 19:01:50 -06:00
committed by GitHub
parent 5f708a2002
commit 822f84c1c1
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
src/core_pkg/core_pkg/core_node.py
View File

@@ -210,11 +210,11 @@ class SerialRelay(Node):
self.core_feedback.bno_gyro.y = float(parts[4])
self.core_feedback.bno_gyro.z = float(parts[5])
self.core_feedback.imu_calib = round(float(parts[6]))
elif output.startswith("can_relay_fromvic,core,52"): #Accel x,y,z, heading *10
elif output.startswith("can_relay_fromvic,core,52"): #Accel x,y,z, heading
self.core_feedback.bno_accel.x = float(parts[3])
self.core_feedback.bno_accel.y = float(parts[4])
self.core_feedback.bno_accel.z = float(parts[5])
self.core_feedback.orientation = float(parts[6]) / 10.0
self.core_feedback.orientation = float(parts[6])
elif output.startswith("can_relay_fromvic,core,53"): #Rev motor feedback
motorId = int(parts[3])
temp = float(parts[4]) / 10.0