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__":