From c63afacf5e74fa4e63eac1ac7fa76d8e38038fcc Mon Sep 17 00:00:00 2001 From: Ros2TestWin Date: Wed, 17 Apr 2024 01:09:26 -0700 Subject: [PATCH] =?UTF-8?q?=E5=A2=9E=E5=8A=A0=E9=9B=BB=E6=B1=A0=E8=B3=87?= =?UTF-8?q?=E8=A8=8A=E6=B8=AC=E8=A9=A6(=E9=9B=BB=E6=B5=81=E6=BA=AB?= =?UTF-8?q?=E5=BA=A6)?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- test3_vel_gps_bat_head.py | 15 +++++++++++++-- 1 file changed, 13 insertions(+), 2 deletions(-) diff --git a/test3_vel_gps_bat_head.py b/test3_vel_gps_bat_head.py index fc587a9..652d7e5 100644 --- a/test3_vel_gps_bat_head.py +++ b/test3_vel_gps_bat_head.py @@ -5,10 +5,12 @@ from mavsdk.telemetry_server import (StatusText,StatusTextType,Battery,Position, import random async def run(): + # drone = System(port=50053, sysid=96, compid=1) drone = System(port=50053) print("456") - await drone.connect(system_address="udp://:14550") + # await drone.connect(system_address="udp://127.0.0.1:14550") + await drone.connect() print("123") await drone.telemetry_server.publish_status_text(StatusText(StatusTextType.ALERT,"Check")) @@ -50,7 +52,16 @@ async def run(): await drone.telemetry_server.publish_battery(Battery(voltage_v,remaining_percent)) await drone.telemetry_server.publish_position(position,velocity_ned,heading) await drone.telemetry_server.publish_raw_gps(raw_gps,gps_info) - await asyncio.sleep(1) + + vehicle_battery_temperature = random.uniform(20.0,150.0) # 電池溫度 + vehicle_battery_current = random.uniform(0.0,15.0) # 電池電流 + vehicle_battery_CAT = "I" + str(vehicle_battery_current) + "," + "T" + str(vehicle_battery_temperature) + print(vehicle_battery_CAT) + await drone.telemetry_server.publish_status_text(StatusText(StatusTextType.INFO,vehicle_battery_CAT)) + await asyncio.sleep(2) + + + #print("remaining_percent: ",remaining_percent) if __name__ == "__main__":