diff --git a/src/core_pkg/core_pkg/core_node.py b/src/core_pkg/core_pkg/core_node.py index ca3555b..6c650e9 100644 --- a/src/core_pkg/core_pkg/core_node.py +++ b/src/core_pkg/core_pkg/core_node.py @@ -202,6 +202,9 @@ class SerialRelay(Node): self.core_feedback.gps_long = float(parts[3]) elif output.startswith("can_relay_fromvic,core,50"):#GNSS Satellite Count self.core_feedback.gps_sats = round(float(parts[3])) + #if parts length is at least 5 then we should have altitude, this is a temporary check until fully implemented + if len(parts) >= 5: + self.core_feedback.gps_alt = round(float(parts[4]), 2) elif output.startswith("can_relay_fromvic,core,51"):#Gyro x,y,z self.core_feedback.bno_gyro.x = float(parts[3]) self.core_feedback.bno_gyro.y = float(parts[4]) diff --git a/src/ros2_interfaces_pkg b/src/ros2_interfaces_pkg index a412af5..4153f2c 160000 --- a/src/ros2_interfaces_pkg +++ b/src/ros2_interfaces_pkg @@ -1 +1 @@ -Subproject commit a412af5017e73c4090bc5ebe709546561afcbebe +Subproject commit 4153f2c8186f3995facde953c5d5f274337ad5a2