diff --git a/src/fc_network_adapter/fc_network_adapter/mavlinkROS2Nodes.py b/src/fc_network_adapter/fc_network_adapter/mavlinkROS2Nodes.py index 1cfd3b9..6948673 100644 --- a/src/fc_network_adapter/fc_network_adapter/mavlinkROS2Nodes.py +++ b/src/fc_network_adapter/fc_network_adapter/mavlinkROS2Nodes.py @@ -230,9 +230,7 @@ class VehicleStatusPublisher(Node): msg.stamp = self.get_clock().now().to_msg() msg.latitude = float(pos.latitude) msg.longitude = float(pos.longitude) - # 發布「相對 home 高度」而非 AMSL:下游 GUI / mission planner 一律以相對高度做運算與指令, - # 若這裡發 AMSL(msg.alt)會在實飛時把海拔當成相對高度傳給飛控,造成 Circle 高度衝高的 bug - msg.altitude = float(pos.relative_altitude) if pos.relative_altitude is not None else 0.0 + msg.altitude = float(pos.altitude) if pos.altitude is not None else 0.0 # GPS 狀態資訊 gps = status.gps