95 lines
2.2 KiB
Python
95 lines
2.2 KiB
Python
|
from dataclasses import dataclass
|
|||
|
|
import json
|
|||
|
|
from typing import Optional
|
|||
|
|
import asyncio
|
|||
|
|
|
|||
|
|
|
|||
|
|
@dataclass
|
|||
|
|
class OSDInfo:
|
|||
|
|
attitude_head: float
|
|||
|
|
elevation: float
|
|||
|
|
gimbal_pitch: float
|
|||
|
|
gimbal_roll: float
|
|||
|
|
gimbal_yaw: float
|
|||
|
|
height: float
|
|||
|
|
home_distance: float
|
|||
|
|
horizontal_speed: float
|
|||
|
|
latitude: float
|
|||
|
|
longitude: float
|
|||
|
|
speed_x: float
|
|||
|
|
speed_y: float
|
|||
|
|
speed_z: float
|
|||
|
|
ultrasonic_height: float
|
|||
|
|
vertical_speed: float
|
|||
|
|
wind_direction: float
|
|||
|
|
wind_speed: float
|
|||
|
|
|
|||
|
|
|
|||
|
|
@dataclass
|
|||
|
|
class OSDMessage:
|
|||
|
|
data: OSDInfo
|
|||
|
|
method: str
|
|||
|
|
seq: int
|
|||
|
|
timestamp: int
|
|||
|
|
|
|||
|
|
|
|||
|
|
def parse_osd_message(json_str: Optional[str]) -> Optional[OSDMessage]:
|
|||
|
|
if not json_str:
|
|||
|
|
return None
|
|||
|
|
|
|||
|
|
try:
|
|||
|
|
data=json_str
|
|||
|
|
osd_info = OSDInfo(**data["data"])
|
|||
|
|
return OSDMessage(
|
|||
|
|
data=osd_info,
|
|||
|
|
method=data["method"],
|
|||
|
|
seq=data["seq"],
|
|||
|
|
timestamp=data["timestamp"]
|
|||
|
|
)
|
|||
|
|
except Exception as e:
|
|||
|
|
print(f"Error parsing OSD message: {e}")
|
|||
|
|
return None
|
|||
|
|
|
|||
|
|
|
|||
|
|
async def main():
|
|||
|
|
# 这里应该是获取latest_osd_info的实际逻辑
|
|||
|
|
latest_osd_info = '''{
|
|||
|
|
"data": {
|
|||
|
|
"attitude_head": -31.6,
|
|||
|
|
"elevation": 100.5,
|
|||
|
|
"gimbal_pitch": -46.9,
|
|||
|
|
"gimbal_roll": 0,
|
|||
|
|
"gimbal_yaw": -31.507293194051584,
|
|||
|
|
"height": 581.8057861328125,
|
|||
|
|
"home_distance": 0.045968499034643173,
|
|||
|
|
"horizontal_speed": 0,
|
|||
|
|
"latitude": 30.762902409980541,
|
|||
|
|
"longitude": 103.99185861184533,
|
|||
|
|
"speed_x": 0,
|
|||
|
|
"speed_y": 0,
|
|||
|
|
"speed_z": 0,
|
|||
|
|
"ultrasonic_height": -1,
|
|||
|
|
"vertical_speed": -0,
|
|||
|
|
"wind_direction": 5,
|
|||
|
|
"wind_speed": 33
|
|||
|
|
},
|
|||
|
|
"method": "osd_info_push",
|
|||
|
|
"seq": 257050,
|
|||
|
|
"timestamp": 1754910838301
|
|||
|
|
}'''
|
|||
|
|
|
|||
|
|
message = parse_osd_message(latest_osd_info)
|
|||
|
|
if message:
|
|||
|
|
print(f"Latitude: {message.data.latitude}")
|
|||
|
|
else:
|
|||
|
|
print("Failed to parse OSD message")
|
|||
|
|
|
|||
|
|
|
|||
|
|
if __name__ == '__main__':
|
|||
|
|
# 设置Windows兼容事件循环（如果需要）
|
|||
|
|
try:
|
|||
|
|
asyncio.set_event_loop_policy(asyncio.WindowsSelectorEventLoopPolicy())
|
|||
|
|
except:
|
|||
|
|
pass
|
|||
|
|
|
|||
|
|
asyncio.run(main())
|