px4-configuration 0.2.1__py3-none-any.whl → 0.2.2__py3-none-any.whl
This diff represents the content of publicly available package versions that have been released to one of the supported registries. The information contained in this diff is provided for informational purposes only and reflects changes between package versions as they appear in their respective public registries.
- px4_configuration/api/__init__.py +2 -2
- px4_configuration/api/config.py +12 -2
- px4_configuration/api/models.py +64 -1
- px4_configuration/api/services/calibration_service.py +193 -101
- px4_configuration/api/services/health_service.py +154 -163
- px4_configuration/api/services/param_service.py +26 -7
- px4_configuration/api/services/sdcard_service.py +26 -7
- px4_configuration/api/services/shell_service.py +41 -15
- {px4_configuration-0.2.1.dist-info → px4_configuration-0.2.2.dist-info}/METADATA +2 -2
- px4_configuration-0.2.2.dist-info/RECORD +17 -0
- px4_configuration-0.2.1.dist-info/RECORD +0 -17
- {px4_configuration-0.2.1.dist-info → px4_configuration-0.2.2.dist-info}/WHEEL +0 -0
- {px4_configuration-0.2.1.dist-info → px4_configuration-0.2.2.dist-info}/entry_points.txt +0 -0
px4_configuration/api/config.py
CHANGED
|
@@ -3,6 +3,16 @@
|
|
|
3
3
|
import os
|
|
4
4
|
|
|
5
5
|
|
|
6
|
+
def _get_package_version() -> str:
|
|
7
|
+
"""Read version from package metadata (pyproject.toml). Single source of truth."""
|
|
8
|
+
try:
|
|
9
|
+
from importlib.metadata import PackageNotFoundError, version
|
|
10
|
+
|
|
11
|
+
return version("px4-configuration")
|
|
12
|
+
except Exception:
|
|
13
|
+
return "0.0.0"
|
|
14
|
+
|
|
15
|
+
|
|
6
16
|
class Settings:
|
|
7
17
|
"""Application settings with defaults."""
|
|
8
18
|
|
|
@@ -10,9 +20,9 @@ class Settings:
|
|
|
10
20
|
default_port: str = os.getenv("PX4_DEFAULT_PORT", "/dev/pixhawk")
|
|
11
21
|
default_baudrate: int = int(os.getenv("PX4_DEFAULT_BAUDRATE", "2000000"))
|
|
12
22
|
|
|
13
|
-
# API settings
|
|
23
|
+
# API settings (version from pyproject.toml via package metadata)
|
|
14
24
|
api_title: str = "PX4 Configuration API"
|
|
15
|
-
api_version: str =
|
|
25
|
+
api_version: str = _get_package_version()
|
|
16
26
|
api_description: str = (
|
|
17
27
|
"REST API for configuring PX4 flight controller from companion computer"
|
|
18
28
|
)
|
px4_configuration/api/models.py
CHANGED
|
@@ -1,7 +1,7 @@
|
|
|
1
1
|
from __future__ import annotations
|
|
2
2
|
|
|
3
3
|
from enum import Enum
|
|
4
|
-
from typing import Literal, Optional, Dict, Any
|
|
4
|
+
from typing import Literal, Optional, Dict, Any, List
|
|
5
5
|
|
|
6
6
|
from pydantic import BaseModel, Field, ConfigDict
|
|
7
7
|
|
|
@@ -59,6 +59,61 @@ class CalibrationHealth(BaseModel):
|
|
|
59
59
|
"""Whether the calibration is required."""
|
|
60
60
|
return not (self.gyroscope_ok and self.accelerometer_ok and self.magnetometer_ok)
|
|
61
61
|
|
|
62
|
+
|
|
63
|
+
class HealthAndArmingCheckProblem(BaseModel):
|
|
64
|
+
"""A single health/arming check problem from PX4 Events."""
|
|
65
|
+
|
|
66
|
+
message: str = Field(..., description="Short, single-line message.")
|
|
67
|
+
description: str = Field(default="", description="Detailed description (optional).")
|
|
68
|
+
health_component: str = Field(default="", description="Associated component, e.g. 'gps'.")
|
|
69
|
+
|
|
70
|
+
|
|
71
|
+
class HealthAndArmingCheckMode(BaseModel):
|
|
72
|
+
"""Arming checks for a specific flight mode (from PX4 Events)."""
|
|
73
|
+
|
|
74
|
+
mode_name: str = Field(..., description="Mode name, e.g. 'Position'.")
|
|
75
|
+
can_arm_or_run: bool = Field(
|
|
76
|
+
...,
|
|
77
|
+
description="If disarmed: whether arming is possible. If armed: whether the mode can be selected.",
|
|
78
|
+
)
|
|
79
|
+
problems: List[HealthAndArmingCheckProblem] = Field(
|
|
80
|
+
default_factory=list,
|
|
81
|
+
description="List of reported problems for this mode.",
|
|
82
|
+
)
|
|
83
|
+
|
|
84
|
+
|
|
85
|
+
class HealthComponentReport(BaseModel):
|
|
86
|
+
"""Health component report (e.g. GPS, Accelerometer) from PX4 Events."""
|
|
87
|
+
|
|
88
|
+
name: str = Field(..., description="Unique component name, e.g. 'gps'.")
|
|
89
|
+
label: str = Field(..., description="Human-readable label, e.g. 'GPS'.")
|
|
90
|
+
is_present: bool = Field(..., description="Whether the component is present.")
|
|
91
|
+
has_error: bool = Field(..., description="Whether the component has errors.")
|
|
92
|
+
has_warning: bool = Field(..., description="Whether the component has warnings.")
|
|
93
|
+
|
|
94
|
+
|
|
95
|
+
class HealthAndArmingCheckReport(BaseModel):
|
|
96
|
+
"""
|
|
97
|
+
Health and arming checks report from MAVSDK Events plugin.
|
|
98
|
+
|
|
99
|
+
Provides detailed readiness-to-fly information: current mode arming status,
|
|
100
|
+
per-component health, and all reported problems.
|
|
101
|
+
"""
|
|
102
|
+
|
|
103
|
+
current_mode_intention: Optional[HealthAndArmingCheckMode] = Field(
|
|
104
|
+
default=None,
|
|
105
|
+
description="Report for the currently intended flight mode (can_arm_or_run, problems).",
|
|
106
|
+
)
|
|
107
|
+
health_components: List[HealthComponentReport] = Field(
|
|
108
|
+
default_factory=list,
|
|
109
|
+
description="Health components (e.g. gps, accelerometer) with present/error/warning flags.",
|
|
110
|
+
)
|
|
111
|
+
all_problems: List[HealthAndArmingCheckProblem] = Field(
|
|
112
|
+
default_factory=list,
|
|
113
|
+
description="Complete list of all reported problems.",
|
|
114
|
+
)
|
|
115
|
+
|
|
116
|
+
|
|
62
117
|
class Px4HealthResponse(BaseModel):
|
|
63
118
|
"""
|
|
64
119
|
High-level PX4 health snapshot.
|
|
@@ -111,6 +166,14 @@ class Px4HealthResponse(BaseModel):
|
|
|
111
166
|
description="True if PX4 considers the vehicle armable.",
|
|
112
167
|
)
|
|
113
168
|
|
|
169
|
+
arming_checks_report: Optional[HealthAndArmingCheckReport] = Field(
|
|
170
|
+
default=None,
|
|
171
|
+
description=(
|
|
172
|
+
"Detailed health and arming checks from MAVSDK Events plugin "
|
|
173
|
+
"(mode intention, health components, all problems). None if Events plugin unavailable."
|
|
174
|
+
),
|
|
175
|
+
)
|
|
176
|
+
|
|
114
177
|
raw_health: Optional[Dict[str, Any]] = Field(
|
|
115
178
|
default=None,
|
|
116
179
|
description=(
|
|
@@ -2,10 +2,17 @@
|
|
|
2
2
|
|
|
3
3
|
from __future__ import annotations
|
|
4
4
|
|
|
5
|
-
|
|
5
|
+
import asyncio
|
|
6
|
+
from typing import AsyncGenerator, Dict, Any, Optional
|
|
6
7
|
|
|
7
8
|
from mavsdk import System
|
|
8
9
|
|
|
10
|
+
try:
|
|
11
|
+
from grpc import RpcError
|
|
12
|
+
except ImportError:
|
|
13
|
+
# Fallback if grpc is not directly available (shouldn't happen with mavsdk)
|
|
14
|
+
RpcError = Exception
|
|
15
|
+
|
|
9
16
|
from ..models import CalibrationType
|
|
10
17
|
from ..utils.calibration_parser import (
|
|
11
18
|
parse_accelerometer_progress,
|
|
@@ -15,6 +22,40 @@ from ..utils.calibration_parser import (
|
|
|
15
22
|
)
|
|
16
23
|
|
|
17
24
|
|
|
25
|
+
def _format_grpc_error(exc: Exception) -> str:
|
|
26
|
+
"""Format gRPC errors into user-friendly messages."""
|
|
27
|
+
error_msg = str(exc)
|
|
28
|
+
|
|
29
|
+
if isinstance(exc, RpcError):
|
|
30
|
+
# Check for COMMAND_DENIED (PX4 rejected the command)
|
|
31
|
+
if "COMMAND_DENIED" in error_msg:
|
|
32
|
+
return (
|
|
33
|
+
"PX4 rejected the calibration command. "
|
|
34
|
+
"This may occur if: (1) a calibration is already in progress, "
|
|
35
|
+
"(2) the vehicle is armed or in flight, (3) the vehicle is not in the correct state. "
|
|
36
|
+
"Please ensure the vehicle is disarmed, on the ground, and no other calibration is running."
|
|
37
|
+
)
|
|
38
|
+
# Check for common gRPC error patterns
|
|
39
|
+
if "Connection reset by peer" in error_msg or "UNAVAILABLE" in error_msg:
|
|
40
|
+
return (
|
|
41
|
+
"Connection to PX4 device was lost. "
|
|
42
|
+
"This may occur if the device disconnected, rebooted, or the connection timed out. "
|
|
43
|
+
"Please check the device connection and try again."
|
|
44
|
+
)
|
|
45
|
+
elif "DEADLINE_EXCEEDED" in error_msg or "timeout" in error_msg.lower():
|
|
46
|
+
return (
|
|
47
|
+
"Connection timeout. The device may be unresponsive. "
|
|
48
|
+
"Please check the device connection and try again."
|
|
49
|
+
)
|
|
50
|
+
elif "PERMISSION_DENIED" in error_msg:
|
|
51
|
+
return "Permission denied. Please check device permissions."
|
|
52
|
+
else:
|
|
53
|
+
return f"gRPC error: {error_msg}"
|
|
54
|
+
|
|
55
|
+
# For non-gRPC exceptions, return the error message as-is
|
|
56
|
+
return error_msg
|
|
57
|
+
|
|
58
|
+
|
|
18
59
|
async def calibrate_sensors(
|
|
19
60
|
port: str,
|
|
20
61
|
baudrate: int,
|
|
@@ -26,119 +67,170 @@ async def calibrate_sensors(
|
|
|
26
67
|
This function is transport-agnostic: it does NOT produce SSE-formatted strings.
|
|
27
68
|
It yields plain Python dicts suitable for JSON serialization. The API layer
|
|
28
69
|
(FastAPI endpoint) is responsible for converting these dicts into SSE frames.
|
|
70
|
+
|
|
71
|
+
The function properly handles connection cleanup and gRPC errors.
|
|
29
72
|
"""
|
|
30
73
|
|
|
31
74
|
serial = f"serial://{port}:{baudrate}"
|
|
32
|
-
drone =
|
|
33
|
-
|
|
34
|
-
# Initial status messages
|
|
35
|
-
yield {
|
|
36
|
-
"type": "status",
|
|
37
|
-
"message": f"Connecting to {port}...",
|
|
38
|
-
}
|
|
39
|
-
|
|
40
|
-
# Connect to the PX4 system
|
|
41
|
-
await drone.connect(system_address=serial)
|
|
42
|
-
|
|
43
|
-
yield {
|
|
44
|
-
"type": "status",
|
|
45
|
-
"message": "Connected to device",
|
|
46
|
-
}
|
|
47
|
-
|
|
48
|
-
# Dispatch based on calibration type
|
|
49
|
-
if calibration_type is CalibrationType.GYROSCOPE:
|
|
50
|
-
# Gyroscope calibration
|
|
51
|
-
yield {
|
|
52
|
-
"type": "status",
|
|
53
|
-
"message": "Starting gyroscope calibration...",
|
|
54
|
-
}
|
|
55
|
-
|
|
56
|
-
prev: Dict[str, Any] | None = None
|
|
57
|
-
async for progress_data in drone.calibration.calibrate_gyro():
|
|
58
|
-
structured_data = parse_gyroscope_progress(progress_data, prev=prev)
|
|
59
|
-
prev = structured_data
|
|
60
|
-
yield structured_data
|
|
61
|
-
|
|
62
|
-
yield {
|
|
63
|
-
"type": "gyroscope_complete",
|
|
64
|
-
"message": "Gyroscope calibration finished",
|
|
65
|
-
"is_complete": True,
|
|
66
|
-
}
|
|
67
|
-
|
|
68
|
-
elif calibration_type is CalibrationType.ACCELEROMETER:
|
|
69
|
-
# Accelerometer calibration
|
|
70
|
-
yield {
|
|
71
|
-
"type": "status",
|
|
72
|
-
"message": "Starting accelerometer calibration...",
|
|
73
|
-
}
|
|
74
|
-
|
|
75
|
-
prev = None
|
|
76
|
-
async for progress_data in drone.calibration.calibrate_accelerometer():
|
|
77
|
-
structured_data = parse_accelerometer_progress(progress_data, prev=prev)
|
|
78
|
-
prev = structured_data
|
|
79
|
-
yield structured_data
|
|
80
|
-
|
|
81
|
-
yield {
|
|
82
|
-
"type": "accelerometer_complete",
|
|
83
|
-
"message": "Accelerometer calibration finished",
|
|
84
|
-
"is_complete": True,
|
|
85
|
-
}
|
|
75
|
+
drone: Optional[System] = None
|
|
86
76
|
|
|
87
|
-
|
|
88
|
-
#
|
|
77
|
+
try:
|
|
78
|
+
# Initial status messages
|
|
89
79
|
yield {
|
|
90
80
|
"type": "status",
|
|
91
|
-
"message": "
|
|
81
|
+
"message": f"Connecting to {port}...",
|
|
92
82
|
}
|
|
93
83
|
|
|
94
|
-
|
|
95
|
-
|
|
96
|
-
|
|
97
|
-
prev = structured_data
|
|
98
|
-
yield structured_data
|
|
84
|
+
# Create and connect to the PX4 system
|
|
85
|
+
drone = System()
|
|
86
|
+
await drone.connect(system_address=serial)
|
|
99
87
|
|
|
100
|
-
|
|
101
|
-
|
|
102
|
-
|
|
103
|
-
|
|
104
|
-
}
|
|
88
|
+
# Wait for connection to be established
|
|
89
|
+
async for state in drone.core.connection_state():
|
|
90
|
+
if state.is_connected:
|
|
91
|
+
break
|
|
105
92
|
|
|
106
|
-
elif calibration_type is CalibrationType.HORIZON:
|
|
107
|
-
# Level horizon calibration
|
|
108
93
|
yield {
|
|
109
94
|
"type": "status",
|
|
110
|
-
"message": "
|
|
111
|
-
}
|
|
112
|
-
|
|
113
|
-
prev = None
|
|
114
|
-
async for progress_data in drone.calibration.calibrate_level_horizon():
|
|
115
|
-
structured_data = parse_horizon_progress(progress_data, prev=prev)
|
|
116
|
-
prev = structured_data
|
|
117
|
-
yield structured_data
|
|
118
|
-
|
|
119
|
-
yield {
|
|
120
|
-
"type": "horizon_complete",
|
|
121
|
-
"message": "Level horizon calibration finished",
|
|
122
|
-
"is_complete": True,
|
|
95
|
+
"message": "Connected to device",
|
|
123
96
|
}
|
|
124
97
|
|
|
125
|
-
|
|
126
|
-
#
|
|
127
|
-
|
|
128
|
-
|
|
129
|
-
|
|
130
|
-
|
|
98
|
+
# Small delay to ensure connection is stable before starting calibration
|
|
99
|
+
# This helps avoid COMMAND_DENIED errors from rapid-fire requests
|
|
100
|
+
await asyncio.sleep(0.1)
|
|
101
|
+
|
|
102
|
+
# Dispatch based on calibration type
|
|
103
|
+
if calibration_type is CalibrationType.GYROSCOPE:
|
|
104
|
+
# Gyroscope calibration
|
|
105
|
+
yield {
|
|
106
|
+
"type": "status",
|
|
107
|
+
"message": "Starting gyroscope calibration...",
|
|
108
|
+
}
|
|
109
|
+
|
|
110
|
+
prev: Dict[str, Any] | None = None
|
|
111
|
+
try:
|
|
112
|
+
async for progress_data in drone.calibration.calibrate_gyro():
|
|
113
|
+
structured_data = parse_gyroscope_progress(progress_data, prev=prev)
|
|
114
|
+
prev = structured_data
|
|
115
|
+
yield structured_data
|
|
116
|
+
except (RpcError, Exception) as exc:
|
|
117
|
+
yield {
|
|
118
|
+
"type": "error",
|
|
119
|
+
"message": f"Gyroscope calibration failed: {_format_grpc_error(exc)}",
|
|
120
|
+
}
|
|
121
|
+
raise
|
|
122
|
+
|
|
123
|
+
yield {
|
|
124
|
+
"type": "gyroscope_complete",
|
|
125
|
+
"message": "Gyroscope calibration finished",
|
|
126
|
+
"is_complete": True,
|
|
127
|
+
}
|
|
128
|
+
|
|
129
|
+
elif calibration_type is CalibrationType.ACCELEROMETER:
|
|
130
|
+
# Accelerometer calibration
|
|
131
|
+
yield {
|
|
132
|
+
"type": "status",
|
|
133
|
+
"message": "Starting accelerometer calibration...",
|
|
134
|
+
}
|
|
135
|
+
|
|
136
|
+
prev = None
|
|
137
|
+
try:
|
|
138
|
+
async for progress_data in drone.calibration.calibrate_accelerometer():
|
|
139
|
+
structured_data = parse_accelerometer_progress(progress_data, prev=prev)
|
|
140
|
+
prev = structured_data
|
|
141
|
+
yield structured_data
|
|
142
|
+
except (RpcError, Exception) as exc:
|
|
143
|
+
yield {
|
|
144
|
+
"type": "error",
|
|
145
|
+
"message": f"Accelerometer calibration failed: {_format_grpc_error(exc)}",
|
|
146
|
+
}
|
|
147
|
+
raise
|
|
148
|
+
|
|
149
|
+
yield {
|
|
150
|
+
"type": "accelerometer_complete",
|
|
151
|
+
"message": "Accelerometer calibration finished",
|
|
152
|
+
"is_complete": True,
|
|
153
|
+
}
|
|
154
|
+
|
|
155
|
+
elif calibration_type is CalibrationType.MAGNETOMETER:
|
|
156
|
+
# Magnetometer calibration
|
|
157
|
+
yield {
|
|
158
|
+
"type": "status",
|
|
159
|
+
"message": "Starting magnetometer calibration...",
|
|
160
|
+
}
|
|
161
|
+
|
|
162
|
+
prev = None
|
|
163
|
+
try:
|
|
164
|
+
async for progress_data in drone.calibration.calibrate_magnetometer():
|
|
165
|
+
structured_data = parse_magnetometer_progress(progress_data, prev=prev)
|
|
166
|
+
prev = structured_data
|
|
167
|
+
yield structured_data
|
|
168
|
+
except (RpcError, Exception) as exc:
|
|
169
|
+
yield {
|
|
170
|
+
"type": "error",
|
|
171
|
+
"message": f"Magnetometer calibration failed: {_format_grpc_error(exc)}",
|
|
172
|
+
}
|
|
173
|
+
raise
|
|
174
|
+
|
|
175
|
+
yield {
|
|
176
|
+
"type": "magnetometer_complete",
|
|
177
|
+
"message": "Magnetometer calibration finished",
|
|
178
|
+
"is_complete": True,
|
|
179
|
+
}
|
|
180
|
+
|
|
181
|
+
elif calibration_type is CalibrationType.HORIZON:
|
|
182
|
+
# Level horizon calibration
|
|
183
|
+
yield {
|
|
184
|
+
"type": "status",
|
|
185
|
+
"message": "Starting board level horizon calibration...",
|
|
186
|
+
}
|
|
187
|
+
|
|
188
|
+
prev = None
|
|
189
|
+
try:
|
|
190
|
+
async for progress_data in drone.calibration.calibrate_level_horizon():
|
|
191
|
+
structured_data = parse_horizon_progress(progress_data, prev=prev)
|
|
192
|
+
prev = structured_data
|
|
193
|
+
yield structured_data
|
|
194
|
+
except (RpcError, Exception) as exc:
|
|
195
|
+
yield {
|
|
196
|
+
"type": "error",
|
|
197
|
+
"message": f"Horizon calibration failed: {_format_grpc_error(exc)}",
|
|
198
|
+
}
|
|
199
|
+
raise
|
|
200
|
+
|
|
201
|
+
yield {
|
|
202
|
+
"type": "horizon_complete",
|
|
203
|
+
"message": "Level horizon calibration finished",
|
|
204
|
+
"is_complete": True,
|
|
205
|
+
}
|
|
206
|
+
|
|
207
|
+
elif calibration_type is CalibrationType.ESC:
|
|
208
|
+
# ESC calibration not implemented yet
|
|
209
|
+
yield {
|
|
210
|
+
"type": "status",
|
|
211
|
+
"message": "Starting ESC calibration...",
|
|
212
|
+
}
|
|
213
|
+
yield {
|
|
214
|
+
"type": "warning",
|
|
215
|
+
"message": "ESC calibration not yet implemented",
|
|
216
|
+
}
|
|
217
|
+
yield {
|
|
218
|
+
"type": "status",
|
|
219
|
+
"message": "ESC calibration finished",
|
|
220
|
+
}
|
|
221
|
+
|
|
222
|
+
except (RpcError, Exception) as exc:
|
|
223
|
+
# Handle connection and gRPC errors
|
|
224
|
+
error_message = _format_grpc_error(exc)
|
|
131
225
|
yield {
|
|
132
|
-
"type": "
|
|
133
|
-
"message": "
|
|
226
|
+
"type": "error",
|
|
227
|
+
"message": f"Calibration failed: {error_message}",
|
|
134
228
|
}
|
|
135
|
-
|
|
136
|
-
|
|
137
|
-
|
|
138
|
-
|
|
139
|
-
|
|
140
|
-
|
|
141
|
-
|
|
142
|
-
|
|
143
|
-
"message": "Calibration sequence completed",
|
|
144
|
-
}
|
|
229
|
+
raise
|
|
230
|
+
|
|
231
|
+
finally:
|
|
232
|
+
# Cleanup: Ensure the System object is properly released
|
|
233
|
+
# MAVSDK System objects are cleaned up when they go out of scope,
|
|
234
|
+
# but explicitly setting to None helps with resource management
|
|
235
|
+
if drone is not None:
|
|
236
|
+
drone = None
|
|
@@ -3,74 +3,105 @@
|
|
|
3
3
|
from __future__ import annotations
|
|
4
4
|
|
|
5
5
|
import asyncio
|
|
6
|
-
from typing import
|
|
6
|
+
from typing import Any, Dict, Optional
|
|
7
7
|
|
|
8
8
|
from mavsdk import System
|
|
9
9
|
|
|
10
|
+
try:
|
|
11
|
+
from grpc import RpcError
|
|
12
|
+
except ImportError:
|
|
13
|
+
# Fallback if grpc is not directly available (shouldn't happen with mavsdk)
|
|
14
|
+
RpcError = Exception
|
|
15
|
+
|
|
10
16
|
from ..config import settings
|
|
11
|
-
from ..models import
|
|
17
|
+
from ..models import (
|
|
18
|
+
Px4HealthResponse,
|
|
19
|
+
CalibrationHealth,
|
|
20
|
+
HealthAndArmingCheckReport,
|
|
21
|
+
HealthAndArmingCheckMode,
|
|
22
|
+
HealthAndArmingCheckProblem,
|
|
23
|
+
HealthComponentReport,
|
|
24
|
+
)
|
|
12
25
|
|
|
13
26
|
|
|
14
|
-
async def
|
|
27
|
+
async def _get_stable_health(drone: System, duration_s: float = 2.0) -> Optional[Any]:
|
|
15
28
|
"""
|
|
16
|
-
|
|
17
|
-
|
|
18
|
-
Raises asyncio.TimeoutError if nothing is received within timeout_s.
|
|
29
|
+
Stream health messages for the specified duration and return the latest.
|
|
30
|
+
This skips initial stale messages (all False) and gets accurate values.
|
|
19
31
|
"""
|
|
20
|
-
|
|
32
|
+
latest_health = None
|
|
33
|
+
start_time = asyncio.get_event_loop().time()
|
|
34
|
+
|
|
35
|
+
try:
|
|
21
36
|
async for health in drone.telemetry.health():
|
|
22
|
-
|
|
23
|
-
|
|
24
|
-
|
|
25
|
-
|
|
26
|
-
|
|
27
|
-
|
|
28
|
-
|
|
29
|
-
|
|
30
|
-
|
|
31
|
-
|
|
32
|
-
|
|
33
|
-
|
|
34
|
-
|
|
35
|
-
|
|
36
|
-
|
|
37
|
-
|
|
37
|
+
latest_health = health
|
|
38
|
+
elapsed = asyncio.get_event_loop().time() - start_time
|
|
39
|
+
if elapsed >= duration_s:
|
|
40
|
+
break
|
|
41
|
+
except Exception:
|
|
42
|
+
pass
|
|
43
|
+
|
|
44
|
+
return latest_health
|
|
45
|
+
|
|
46
|
+
|
|
47
|
+
def _convert_arming_checks_report(report: Any) -> HealthAndArmingCheckReport:
|
|
48
|
+
"""Convert MAVSDK HealthAndArmingCheckReport to our Pydantic model."""
|
|
49
|
+
current = getattr(report, "current_mode_intention", None)
|
|
50
|
+
current_mode = None
|
|
51
|
+
if current is not None:
|
|
52
|
+
problems = [
|
|
53
|
+
HealthAndArmingCheckProblem(
|
|
54
|
+
message=getattr(p, "message", ""),
|
|
55
|
+
description=getattr(p, "description", ""),
|
|
56
|
+
health_component=getattr(p, "health_component", ""),
|
|
57
|
+
)
|
|
58
|
+
for p in (getattr(current, "problems", None) or [])
|
|
59
|
+
]
|
|
60
|
+
current_mode = HealthAndArmingCheckMode(
|
|
61
|
+
mode_name=getattr(current, "mode_name", ""),
|
|
62
|
+
can_arm_or_run=getattr(current, "can_arm_or_run", False),
|
|
63
|
+
problems=problems,
|
|
64
|
+
)
|
|
38
65
|
|
|
66
|
+
health_components = [
|
|
67
|
+
HealthComponentReport(
|
|
68
|
+
name=getattr(c, "name", ""),
|
|
69
|
+
label=getattr(c, "label", ""),
|
|
70
|
+
is_present=getattr(c, "is_present", False),
|
|
71
|
+
has_error=getattr(c, "has_error", False),
|
|
72
|
+
has_warning=getattr(c, "has_warning", False),
|
|
73
|
+
)
|
|
74
|
+
for c in (getattr(report, "health_components", None) or [])
|
|
75
|
+
]
|
|
76
|
+
|
|
77
|
+
all_problems = [
|
|
78
|
+
HealthAndArmingCheckProblem(
|
|
79
|
+
message=getattr(p, "message", ""),
|
|
80
|
+
description=getattr(p, "description", ""),
|
|
81
|
+
health_component=getattr(p, "health_component", ""),
|
|
82
|
+
)
|
|
83
|
+
for p in (getattr(report, "all_problems", None) or [])
|
|
84
|
+
]
|
|
39
85
|
|
|
40
|
-
|
|
86
|
+
return HealthAndArmingCheckReport(
|
|
87
|
+
current_mode_intention=current_mode,
|
|
88
|
+
health_components=health_components,
|
|
89
|
+
all_problems=all_problems,
|
|
90
|
+
)
|
|
41
91
|
|
|
42
92
|
|
|
43
|
-
async def
|
|
44
|
-
drone: System,
|
|
45
|
-
family: str,
|
|
46
|
-
indexes: Iterable[int] = SENSOR_INDEXES,
|
|
47
|
-
) -> bool:
|
|
93
|
+
async def _get_arming_checks_report(drone: System) -> Optional[HealthAndArmingCheckReport]:
|
|
48
94
|
"""
|
|
49
|
-
|
|
50
|
-
|
|
51
|
-
A sensor family (gyro/accel/mag) is considered calibrated if ANY
|
|
52
|
-
CAL_FAMILYn_ID != 0 for the probed indexes and the param read succeeds.
|
|
95
|
+
Fetch health and arming checks report from MAVSDK Events plugin.
|
|
96
|
+
Returns None if Events plugin is not available (e.g. older PX4).
|
|
53
97
|
"""
|
|
54
|
-
|
|
55
|
-
|
|
56
|
-
|
|
57
|
-
|
|
58
|
-
|
|
59
|
-
|
|
60
|
-
|
|
61
|
-
return False
|
|
62
|
-
|
|
63
|
-
for i in indexes:
|
|
64
|
-
name = f"{prefix}{i}_ID"
|
|
65
|
-
try:
|
|
66
|
-
sensor_id = await drone.param.get_param_int(name)
|
|
67
|
-
except Exception:
|
|
68
|
-
# Ignore this index if param read fails
|
|
69
|
-
continue
|
|
70
|
-
if sensor_id != 0:
|
|
71
|
-
return True
|
|
72
|
-
|
|
73
|
-
return False
|
|
98
|
+
try:
|
|
99
|
+
report = await drone.events.get_health_and_arming_checks_report()
|
|
100
|
+
if report is None:
|
|
101
|
+
return None
|
|
102
|
+
return _convert_arming_checks_report(report)
|
|
103
|
+
except Exception:
|
|
104
|
+
return None
|
|
74
105
|
|
|
75
106
|
|
|
76
107
|
async def read_px4_health(
|
|
@@ -78,140 +109,95 @@ async def read_px4_health(
|
|
|
78
109
|
baudrate: Optional[int] = None,
|
|
79
110
|
timeout_s: float = 10.0,
|
|
80
111
|
) -> Px4HealthResponse:
|
|
81
|
-
"""
|
|
82
|
-
Connect to PX4 via MAVSDK and return a one-shot health snapshot.
|
|
83
|
-
|
|
84
|
-
- Uses PX4 CAL_* params to derive calibration health.
|
|
85
|
-
- Uses telemetry.health() for armable + positional flags.
|
|
86
|
-
- Uses telemetry.gps_info() for fix type + satellites.
|
|
87
|
-
- Returns Px4HealthResponse; never raises to the API layer.
|
|
88
|
-
"""
|
|
112
|
+
"""Connect to PX4 via MAVSDK and return a health snapshot using telemetry health flags."""
|
|
89
113
|
|
|
90
|
-
# Fallback to global settings if not provided explicitly
|
|
91
114
|
port = port or settings.default_port
|
|
92
115
|
baudrate = baudrate or settings.default_baudrate
|
|
93
116
|
serial = f"serial://{port}:{baudrate}"
|
|
94
117
|
|
|
95
|
-
drone =
|
|
118
|
+
drone: Optional[System] = None
|
|
96
119
|
|
|
97
120
|
try:
|
|
98
|
-
|
|
121
|
+
drone = System()
|
|
99
122
|
await drone.connect(system_address=serial)
|
|
100
123
|
|
|
101
|
-
#
|
|
102
|
-
|
|
103
|
-
|
|
104
|
-
|
|
105
|
-
|
|
106
|
-
|
|
107
|
-
|
|
108
|
-
|
|
109
|
-
|
|
110
|
-
|
|
111
|
-
|
|
112
|
-
|
|
113
|
-
|
|
114
|
-
|
|
115
|
-
|
|
116
|
-
|
|
117
|
-
|
|
118
|
-
|
|
119
|
-
|
|
120
|
-
|
|
124
|
+
# Wait for connection with timeout
|
|
125
|
+
connection_established = False
|
|
126
|
+
try:
|
|
127
|
+
async for state in drone.core.connection_state():
|
|
128
|
+
if state.is_connected:
|
|
129
|
+
connection_established = True
|
|
130
|
+
break
|
|
131
|
+
# Timeout if not connected within reasonable time
|
|
132
|
+
await asyncio.sleep(0.1)
|
|
133
|
+
except (RpcError, Exception):
|
|
134
|
+
connection_established = False
|
|
135
|
+
|
|
136
|
+
if not connection_established:
|
|
137
|
+
return Px4HealthResponse(
|
|
138
|
+
status="disconnected",
|
|
139
|
+
connection_port=port,
|
|
140
|
+
connection_baudrate=baudrate,
|
|
141
|
+
calibration=None,
|
|
142
|
+
gps_fix_type=None,
|
|
143
|
+
satellites_used=None,
|
|
144
|
+
armable=False,
|
|
145
|
+
arming_checks_report=None,
|
|
146
|
+
raw_health=None,
|
|
147
|
+
)
|
|
148
|
+
|
|
149
|
+
# Stream health for 2 seconds to get accurate values (skip initial stale messages)
|
|
150
|
+
health = await asyncio.wait_for(_get_stable_health(drone, duration_s=2.0), timeout_s)
|
|
151
|
+
|
|
152
|
+
if health is None:
|
|
153
|
+
return Px4HealthResponse(
|
|
154
|
+
status="disconnected",
|
|
155
|
+
connection_port=port,
|
|
156
|
+
connection_baudrate=baudrate,
|
|
157
|
+
calibration=None,
|
|
158
|
+
gps_fix_type=None,
|
|
159
|
+
satellites_used=None,
|
|
160
|
+
armable=False,
|
|
161
|
+
arming_checks_report=None,
|
|
162
|
+
raw_health=None,
|
|
163
|
+
)
|
|
121
164
|
|
|
165
|
+
# Use telemetry health flags directly
|
|
122
166
|
calibration = CalibrationHealth(
|
|
123
|
-
gyroscope_ok=
|
|
124
|
-
accelerometer_ok=
|
|
125
|
-
magnetometer_ok=
|
|
167
|
+
gyroscope_ok=health.is_gyrometer_calibration_ok,
|
|
168
|
+
accelerometer_ok=health.is_accelerometer_calibration_ok,
|
|
169
|
+
magnetometer_ok=health.is_magnetometer_calibration_ok,
|
|
126
170
|
)
|
|
127
171
|
|
|
128
|
-
#
|
|
129
|
-
|
|
130
|
-
health = await _get_health_once(drone, timeout_s=timeout_s / 2)
|
|
131
|
-
except asyncio.TimeoutError:
|
|
132
|
-
health = None
|
|
133
|
-
|
|
134
|
-
# -------- GPS INFO (unchanged) --------
|
|
135
|
-
try:
|
|
136
|
-
gps_info = await _get_gps_info_once(drone, timeout_s=timeout_s / 2)
|
|
137
|
-
except asyncio.TimeoutError:
|
|
138
|
-
gps_info = None
|
|
139
|
-
|
|
140
|
-
gps_fix_type: Optional[str] = None
|
|
141
|
-
satellites_used: Optional[int] = None
|
|
142
|
-
|
|
143
|
-
if gps_info is not None:
|
|
144
|
-
if hasattr(gps_info.fix_type, "name"):
|
|
145
|
-
gps_fix_type = gps_info.fix_type.name.lower()
|
|
146
|
-
else:
|
|
147
|
-
gps_fix_type = str(gps_info.fix_type).lower()
|
|
148
|
-
|
|
149
|
-
satellites_used = int(getattr(gps_info, "num_satellites", 0))
|
|
150
|
-
|
|
151
|
-
# -------- STATUS + ARMABLE (respect your Literal) --------
|
|
152
|
-
armable: Optional[bool] = None
|
|
153
|
-
if health is not None:
|
|
154
|
-
armable = health.is_armable
|
|
155
|
-
|
|
156
|
-
# Map everything into your fixed status vocabulary:
|
|
157
|
-
# - disconnected: handled in exception / early return
|
|
158
|
-
# - ok: armable and all calibrated
|
|
159
|
-
# - degraded: anything else (not armable or missing calibration)
|
|
160
|
-
if armable and not calibration.requires_calibration:
|
|
161
|
-
status = "ok"
|
|
162
|
-
else:
|
|
163
|
-
status = "degraded"
|
|
164
|
-
|
|
165
|
-
# -------- RAW HEALTH FOR DEBUG/UI --------
|
|
166
|
-
raw_health: Dict[str, Any] = {}
|
|
167
|
-
|
|
168
|
-
# Telemetry-derived bits (if available)
|
|
169
|
-
if health is not None:
|
|
170
|
-
raw_health.update(
|
|
171
|
-
{
|
|
172
|
-
"is_gyrometer_calibration_ok": health.is_gyrometer_calibration_ok,
|
|
173
|
-
"is_accelerometer_calibration_ok": health.is_accelerometer_calibration_ok,
|
|
174
|
-
"is_magnetometer_calibration_ok": health.is_magnetometer_calibration_ok,
|
|
175
|
-
"is_local_position_ok": getattr(health, "is_local_position_ok", None),
|
|
176
|
-
"is_global_position_ok": getattr(health, "is_global_position_ok", None),
|
|
177
|
-
"is_home_position_ok": getattr(health, "is_home_position_ok", None),
|
|
178
|
-
"is_armable": health.is_armable,
|
|
179
|
-
}
|
|
180
|
-
)
|
|
181
|
-
else:
|
|
182
|
-
raw_health.update(
|
|
183
|
-
{
|
|
184
|
-
"is_gyrometer_calibration_ok": None,
|
|
185
|
-
"is_accelerometer_calibration_ok": None,
|
|
186
|
-
"is_magnetometer_calibration_ok": None,
|
|
187
|
-
"is_local_position_ok": None,
|
|
188
|
-
"is_global_position_ok": None,
|
|
189
|
-
"is_home_position_ok": None,
|
|
190
|
-
"is_armable": None,
|
|
191
|
-
}
|
|
192
|
-
)
|
|
172
|
+
# Determine status
|
|
173
|
+
status = "ok" if (health.is_armable and not calibration.requires_calibration) else "degraded"
|
|
193
174
|
|
|
194
|
-
#
|
|
195
|
-
raw_health[
|
|
196
|
-
"
|
|
197
|
-
"
|
|
198
|
-
"
|
|
199
|
-
"
|
|
175
|
+
# Minimal raw health for debugging
|
|
176
|
+
raw_health: Dict[str, Any] = {
|
|
177
|
+
"raw_health_message": str(health),
|
|
178
|
+
"is_gyrometer_calibration_ok": health.is_gyrometer_calibration_ok,
|
|
179
|
+
"is_accelerometer_calibration_ok": health.is_accelerometer_calibration_ok,
|
|
180
|
+
"is_magnetometer_calibration_ok": health.is_magnetometer_calibration_ok,
|
|
181
|
+
"is_armable": health.is_armable,
|
|
200
182
|
}
|
|
201
183
|
|
|
184
|
+
# Fetch detailed health and arming checks from Events plugin (optional)
|
|
185
|
+
arming_checks_report = await _get_arming_checks_report(drone)
|
|
186
|
+
|
|
202
187
|
return Px4HealthResponse(
|
|
203
188
|
status=status,
|
|
204
189
|
connection_port=port,
|
|
205
190
|
connection_baudrate=baudrate,
|
|
206
191
|
calibration=calibration,
|
|
207
|
-
gps_fix_type=
|
|
208
|
-
satellites_used=
|
|
209
|
-
armable=
|
|
192
|
+
gps_fix_type=None,
|
|
193
|
+
satellites_used=None,
|
|
194
|
+
armable=health.is_armable,
|
|
195
|
+
arming_checks_report=arming_checks_report,
|
|
210
196
|
raw_health=raw_health,
|
|
211
197
|
)
|
|
212
198
|
|
|
213
|
-
except (
|
|
214
|
-
#
|
|
199
|
+
except (RpcError, Exception):
|
|
200
|
+
# Return disconnected status on any error
|
|
215
201
|
return Px4HealthResponse(
|
|
216
202
|
status="disconnected",
|
|
217
203
|
connection_port=port,
|
|
@@ -220,5 +206,10 @@ async def read_px4_health(
|
|
|
220
206
|
gps_fix_type=None,
|
|
221
207
|
satellites_used=None,
|
|
222
208
|
armable=False,
|
|
209
|
+
arming_checks_report=None,
|
|
223
210
|
raw_health=None,
|
|
224
211
|
)
|
|
212
|
+
finally:
|
|
213
|
+
# Cleanup: Ensure the System object is properly released
|
|
214
|
+
if drone is not None:
|
|
215
|
+
drone = None
|
|
@@ -1,10 +1,16 @@
|
|
|
1
1
|
"""Service for PX4 parameter upload operations."""
|
|
2
2
|
|
|
3
3
|
import json
|
|
4
|
-
from typing import AsyncGenerator
|
|
4
|
+
from typing import AsyncGenerator, Optional
|
|
5
5
|
|
|
6
6
|
from mavsdk import System
|
|
7
7
|
|
|
8
|
+
try:
|
|
9
|
+
from grpc import RpcError
|
|
10
|
+
except ImportError:
|
|
11
|
+
# Fallback if grpc is not directly available (shouldn't happen with mavsdk)
|
|
12
|
+
RpcError = Exception
|
|
13
|
+
|
|
8
14
|
|
|
9
15
|
async def upload_parameters(
|
|
10
16
|
param_file_path: str,
|
|
@@ -13,7 +19,7 @@ async def upload_parameters(
|
|
|
13
19
|
) -> AsyncGenerator[str, None]:
|
|
14
20
|
"""Upload PX4 parameters from a .params file, streaming progress via SSE."""
|
|
15
21
|
|
|
16
|
-
drone = None
|
|
22
|
+
drone: Optional[System] = None
|
|
17
23
|
try:
|
|
18
24
|
drone = System()
|
|
19
25
|
serial = f"serial://{port}:{baudrate}"
|
|
@@ -22,6 +28,12 @@ async def upload_parameters(
|
|
|
22
28
|
json.dumps({"type": "status", "message": f"Connecting to {port}..."})
|
|
23
29
|
)
|
|
24
30
|
await drone.connect(system_address=serial)
|
|
31
|
+
|
|
32
|
+
# Wait for connection to be established
|
|
33
|
+
async for state in drone.core.connection_state():
|
|
34
|
+
if state.is_connected:
|
|
35
|
+
break
|
|
36
|
+
|
|
25
37
|
yield "data: {}\n\n".format(
|
|
26
38
|
json.dumps({"type": "status", "message": "Connected to device"})
|
|
27
39
|
)
|
|
@@ -133,18 +145,25 @@ async def upload_parameters(
|
|
|
133
145
|
)
|
|
134
146
|
)
|
|
135
147
|
|
|
136
|
-
except Exception as exc: # pragma: no cover - streaming generator
|
|
148
|
+
except (RpcError, Exception) as exc: # pragma: no cover - streaming generator
|
|
149
|
+
error_msg = str(exc)
|
|
150
|
+
if isinstance(exc, RpcError):
|
|
151
|
+
if "Connection reset by peer" in error_msg or "UNAVAILABLE" in error_msg:
|
|
152
|
+
error_msg = (
|
|
153
|
+
"Connection to PX4 device was lost. "
|
|
154
|
+
"This may occur if the device disconnected, rebooted, or the connection timed out."
|
|
155
|
+
)
|
|
137
156
|
yield "data: {}\n\n".format(
|
|
138
157
|
json.dumps(
|
|
139
158
|
{
|
|
140
159
|
"type": "error",
|
|
141
|
-
"message": f"Parameter upload failed: {
|
|
160
|
+
"message": f"Parameter upload failed: {error_msg}",
|
|
142
161
|
}
|
|
143
162
|
)
|
|
144
163
|
)
|
|
145
164
|
raise
|
|
146
165
|
finally:
|
|
147
|
-
|
|
148
|
-
|
|
149
|
-
|
|
166
|
+
# Cleanup: Ensure the System object is properly released
|
|
167
|
+
if drone is not None:
|
|
168
|
+
drone = None
|
|
150
169
|
|
|
@@ -1,10 +1,16 @@
|
|
|
1
1
|
"""Service for uploading files to PX4 SD card via FTP."""
|
|
2
2
|
|
|
3
3
|
import json
|
|
4
|
-
from typing import AsyncGenerator
|
|
4
|
+
from typing import AsyncGenerator, Optional
|
|
5
5
|
|
|
6
6
|
from mavsdk import System
|
|
7
7
|
|
|
8
|
+
try:
|
|
9
|
+
from grpc import RpcError
|
|
10
|
+
except ImportError:
|
|
11
|
+
# Fallback if grpc is not directly available (shouldn't happen with mavsdk)
|
|
12
|
+
RpcError = Exception
|
|
13
|
+
|
|
8
14
|
|
|
9
15
|
async def upload_to_sdcard(
|
|
10
16
|
file_path: str,
|
|
@@ -14,7 +20,7 @@ async def upload_to_sdcard(
|
|
|
14
20
|
) -> AsyncGenerator[str, None]:
|
|
15
21
|
"""Upload a file to the PX4 SD card via MAVSDK FTP and stream progress."""
|
|
16
22
|
|
|
17
|
-
drone = None
|
|
23
|
+
drone: Optional[System] = None
|
|
18
24
|
try:
|
|
19
25
|
drone = System()
|
|
20
26
|
serial = f"serial://{port}:{baudrate}"
|
|
@@ -23,6 +29,12 @@ async def upload_to_sdcard(
|
|
|
23
29
|
json.dumps({"type": "status", "message": f"Connecting to {port}..."})
|
|
24
30
|
)
|
|
25
31
|
await drone.connect(system_address=serial)
|
|
32
|
+
|
|
33
|
+
# Wait for connection to be established
|
|
34
|
+
async for state in drone.core.connection_state():
|
|
35
|
+
if state.is_connected:
|
|
36
|
+
break
|
|
37
|
+
|
|
26
38
|
yield "data: {}\n\n".format(
|
|
27
39
|
json.dumps({"type": "status", "message": "Connected to device"})
|
|
28
40
|
)
|
|
@@ -72,18 +84,25 @@ async def upload_to_sdcard(
|
|
|
72
84
|
json.dumps({"type": "success", "message": "File uploaded successfully"})
|
|
73
85
|
)
|
|
74
86
|
|
|
75
|
-
except Exception as exc: # pragma: no cover - streaming generator
|
|
87
|
+
except (RpcError, Exception) as exc: # pragma: no cover - streaming generator
|
|
88
|
+
error_msg = str(exc)
|
|
89
|
+
if isinstance(exc, RpcError):
|
|
90
|
+
if "Connection reset by peer" in error_msg or "UNAVAILABLE" in error_msg:
|
|
91
|
+
error_msg = (
|
|
92
|
+
"Connection to PX4 device was lost. "
|
|
93
|
+
"This may occur if the device disconnected, rebooted, or the connection timed out."
|
|
94
|
+
)
|
|
76
95
|
yield "data: {}\n\n".format(
|
|
77
96
|
json.dumps(
|
|
78
97
|
{
|
|
79
98
|
"type": "error",
|
|
80
|
-
"message": f"SD card upload failed: {
|
|
99
|
+
"message": f"SD card upload failed: {error_msg}",
|
|
81
100
|
}
|
|
82
101
|
)
|
|
83
102
|
)
|
|
84
103
|
raise
|
|
85
104
|
finally:
|
|
86
|
-
|
|
87
|
-
|
|
88
|
-
|
|
105
|
+
# Cleanup: Ensure the System object is properly released
|
|
106
|
+
if drone is not None:
|
|
107
|
+
drone = None
|
|
89
108
|
|
|
@@ -5,6 +5,12 @@ from typing import Optional
|
|
|
5
5
|
|
|
6
6
|
from mavsdk import System
|
|
7
7
|
|
|
8
|
+
try:
|
|
9
|
+
from grpc import RpcError
|
|
10
|
+
except ImportError:
|
|
11
|
+
# Fallback if grpc is not directly available (shouldn't happen with mavsdk)
|
|
12
|
+
RpcError = Exception
|
|
13
|
+
|
|
8
14
|
|
|
9
15
|
class ShellConnection:
|
|
10
16
|
"""Manage a persistent MAVSDK shell connection with queued output."""
|
|
@@ -19,16 +25,23 @@ class ShellConnection:
|
|
|
19
25
|
async def connect(self) -> None:
|
|
20
26
|
"""Establish connection to PX4 and start shell monitoring."""
|
|
21
27
|
|
|
22
|
-
|
|
23
|
-
|
|
24
|
-
|
|
25
|
-
|
|
26
|
-
|
|
27
|
-
|
|
28
|
-
|
|
29
|
-
|
|
30
|
-
|
|
31
|
-
|
|
28
|
+
try:
|
|
29
|
+
self.drone = System()
|
|
30
|
+
serial = f"serial://{self.port}:{self.baudrate}"
|
|
31
|
+
await self.drone.connect(system_address=serial)
|
|
32
|
+
|
|
33
|
+
# Wait for connection to be established
|
|
34
|
+
async for state in self.drone.core.connection_state():
|
|
35
|
+
if state.is_connected:
|
|
36
|
+
self.connected = True
|
|
37
|
+
break
|
|
38
|
+
|
|
39
|
+
asyncio.create_task(self._observe_shell())
|
|
40
|
+
except (RpcError, Exception) as exc:
|
|
41
|
+
self.connected = False
|
|
42
|
+
if self.drone is not None:
|
|
43
|
+
self.drone = None
|
|
44
|
+
raise RuntimeError(f"Failed to connect to PX4 shell: {exc}") from exc
|
|
32
45
|
|
|
33
46
|
async def _observe_shell(self) -> None:
|
|
34
47
|
"""Monitor shell output and place data into the queue."""
|
|
@@ -38,16 +51,27 @@ class ShellConnection:
|
|
|
38
51
|
|
|
39
52
|
try:
|
|
40
53
|
async for output in self.drone.shell.receive():
|
|
54
|
+
if not self.connected:
|
|
55
|
+
break
|
|
41
56
|
await self.output_queue.put(output)
|
|
42
|
-
except Exception as exc: # pragma: no cover - streaming loop
|
|
43
|
-
|
|
57
|
+
except (RpcError, Exception) as exc: # pragma: no cover - streaming loop
|
|
58
|
+
error_msg = str(exc)
|
|
59
|
+
if isinstance(exc, RpcError):
|
|
60
|
+
if "Connection reset by peer" in error_msg or "UNAVAILABLE" in error_msg:
|
|
61
|
+
error_msg = "Connection to PX4 device was lost"
|
|
62
|
+
await self.output_queue.put(f"Error receiving shell output: {error_msg}")
|
|
63
|
+
self.connected = False
|
|
44
64
|
|
|
45
65
|
async def send_command(self, command: str) -> None:
|
|
46
66
|
"""Send a command to the PX4 shell."""
|
|
47
67
|
|
|
48
68
|
if not self.connected or not self.drone:
|
|
49
69
|
raise RuntimeError("Not connected to PX4")
|
|
50
|
-
|
|
70
|
+
try:
|
|
71
|
+
await self.drone.shell.send(command)
|
|
72
|
+
except (RpcError, Exception) as exc:
|
|
73
|
+
self.connected = False
|
|
74
|
+
raise RuntimeError(f"Failed to send command: {exc}") from exc
|
|
51
75
|
|
|
52
76
|
async def receive_output(self) -> Optional[str]:
|
|
53
77
|
"""Receive shell output (non-blocking)."""
|
|
@@ -58,8 +82,10 @@ class ShellConnection:
|
|
|
58
82
|
return None
|
|
59
83
|
|
|
60
84
|
async def disconnect(self) -> None:
|
|
61
|
-
"""Close the connection
|
|
85
|
+
"""Close the connection and cleanup resources."""
|
|
62
86
|
|
|
63
87
|
self.connected = False
|
|
64
|
-
#
|
|
88
|
+
# Cleanup: Ensure the System object is properly released
|
|
89
|
+
if self.drone is not None:
|
|
90
|
+
self.drone = None
|
|
65
91
|
|
|
@@ -1,12 +1,12 @@
|
|
|
1
1
|
Metadata-Version: 2.4
|
|
2
2
|
Name: px4-configuration
|
|
3
|
-
Version: 0.2.
|
|
3
|
+
Version: 0.2.2
|
|
4
4
|
Summary: Tools and REST API for configuring PX4 from a companion computer
|
|
5
5
|
Author-email: Alex <bonnefond@fly4future.com>
|
|
6
6
|
License: BSD-3-Clause
|
|
7
7
|
Requires-Python: >=3.10
|
|
8
8
|
Requires-Dist: fastapi>=0.104.0
|
|
9
|
-
Requires-Dist: mavsdk==3.
|
|
9
|
+
Requires-Dist: mavsdk==3.10.2
|
|
10
10
|
Requires-Dist: python-multipart>=0.0.6
|
|
11
11
|
Requires-Dist: sse-starlette>=1.6.5
|
|
12
12
|
Requires-Dist: tqdm==4.67.1
|
|
@@ -0,0 +1,17 @@
|
|
|
1
|
+
px4_configuration/__init__.py,sha256=U0jqmbB8mDtIQ_ZPVjfHzoF7b9EM1TFJQRWEJ49Vk1I,334
|
|
2
|
+
px4_configuration/api/__init__.py,sha256=vQzGhWTEdxVccRcgICUNqCWF-1Ts7t_dGryDTnsGKCs,157
|
|
3
|
+
px4_configuration/api/config.py,sha256=onlTwFoMEcbNDRWK77xb_hMZqft_gAEgC8ZR1pPaYLE,920
|
|
4
|
+
px4_configuration/api/main.py,sha256=aeGpssDFcg9xwps3sdRM0tH2p2yYeqkGn9y7QLHw3I4,8278
|
|
5
|
+
px4_configuration/api/models.py,sha256=ltb6N-8g6prR-vNqj_OCh7U0AqqxNDGHZm6ksgWo3DA,6081
|
|
6
|
+
px4_configuration/api/services/__init__.py,sha256=U91RCGMiGcIQqtbnzscfNbWpFw65ZNz0DKabCPtTGMw,163
|
|
7
|
+
px4_configuration/api/services/calibration_service.py,sha256=W5ZpkokPMOjfK3Sf64JAFKiRdrc0QivCYIGfBedLNBc,8451
|
|
8
|
+
px4_configuration/api/services/health_service.py,sha256=WcZR3aioEFVQ1PwrHZYlR3bCKX3-2HdCBA6uPBUbavM,7299
|
|
9
|
+
px4_configuration/api/services/param_service.py,sha256=AUDNckhF05hCK7zOF8l9yI4erD76VWqpFZuglN-ejnQ,5977
|
|
10
|
+
px4_configuration/api/services/sdcard_service.py,sha256=UKZNR6n5c0Xrlpv2TKM2HmG6Rujwr3svZqJ6m050kMQ,3419
|
|
11
|
+
px4_configuration/api/services/shell_service.py,sha256=Df9Zprdu4s1tq2i0-uS83kR76We2f601ULZcLhmmQ9I,3167
|
|
12
|
+
px4_configuration/api/utils/__init__.py,sha256=KR-_U6nAXr8V1uxsB1hCFXPxKYYEwbf096kvhhUJfFk,54
|
|
13
|
+
px4_configuration/api/utils/calibration_parser.py,sha256=rlW4D-ogc0z8o80jBkazZ3oqucAvSMGp_vKfpp5bLp0,10990
|
|
14
|
+
px4_configuration-0.2.2.dist-info/METADATA,sha256=JPSgYEMPqn1HBaK2ts3U6PUbpaslJlbAxTTY9ZavqFM,7109
|
|
15
|
+
px4_configuration-0.2.2.dist-info/WHEEL,sha256=WLgqFyCfm_KASv4WHyYy0P3pM_m7J5L9k2skdKLirC8,87
|
|
16
|
+
px4_configuration-0.2.2.dist-info/entry_points.txt,sha256=mBRa68p2qL9HPLE9nCruYZDtTmuDOhFIbkY_nwX-WTc,67
|
|
17
|
+
px4_configuration-0.2.2.dist-info/RECORD,,
|
|
@@ -1,17 +0,0 @@
|
|
|
1
|
-
px4_configuration/__init__.py,sha256=U0jqmbB8mDtIQ_ZPVjfHzoF7b9EM1TFJQRWEJ49Vk1I,334
|
|
2
|
-
px4_configuration/api/__init__.py,sha256=o0txTrY6RjO1ehOJGtMerrVMm0QR1E4PiutPhoKtmZo,137
|
|
3
|
-
px4_configuration/api/config.py,sha256=imb6qv75ye_DE4t7kbf7xbxWPvy3Yota95keVjg1c5A,562
|
|
4
|
-
px4_configuration/api/main.py,sha256=aeGpssDFcg9xwps3sdRM0tH2p2yYeqkGn9y7QLHw3I4,8278
|
|
5
|
-
px4_configuration/api/models.py,sha256=UeP_FOiimmBxJmeDZ6EGHTodRfQiBNOSt_hSfiVsglI,3546
|
|
6
|
-
px4_configuration/api/services/__init__.py,sha256=U91RCGMiGcIQqtbnzscfNbWpFw65ZNz0DKabCPtTGMw,163
|
|
7
|
-
px4_configuration/api/services/calibration_service.py,sha256=qA5NQx267djW853FKWrfGb6wTsCdqGGpTb3QN6j9zA4,4363
|
|
8
|
-
px4_configuration/api/services/health_service.py,sha256=T1pSMQLxpC41puxQIuTsFj5FVy5NAV0dtTkEoHfHvXE,7539
|
|
9
|
-
px4_configuration/api/services/param_service.py,sha256=95Ee5v3rEGjXiW2LJURTUHXqtxBl2JomV_tMcLwGjac,5201
|
|
10
|
-
px4_configuration/api/services/sdcard_service.py,sha256=6bnMTcaHddo8ZOsrKtl39V518MBO_Z-2fXFT4PTLT5M,2643
|
|
11
|
-
px4_configuration/api/services/shell_service.py,sha256=A_28vCxWyc6e-Usf3QLHqCy5Auf7tyGwqySQ5E5LO1s,2096
|
|
12
|
-
px4_configuration/api/utils/__init__.py,sha256=KR-_U6nAXr8V1uxsB1hCFXPxKYYEwbf096kvhhUJfFk,54
|
|
13
|
-
px4_configuration/api/utils/calibration_parser.py,sha256=rlW4D-ogc0z8o80jBkazZ3oqucAvSMGp_vKfpp5bLp0,10990
|
|
14
|
-
px4_configuration-0.2.1.dist-info/METADATA,sha256=URkhx2PatvDNwcOVKWCyhqv60E6qDyAwnqGj2IaUQ3c,7108
|
|
15
|
-
px4_configuration-0.2.1.dist-info/WHEEL,sha256=WLgqFyCfm_KASv4WHyYy0P3pM_m7J5L9k2skdKLirC8,87
|
|
16
|
-
px4_configuration-0.2.1.dist-info/entry_points.txt,sha256=mBRa68p2qL9HPLE9nCruYZDtTmuDOhFIbkY_nwX-WTc,67
|
|
17
|
-
px4_configuration-0.2.1.dist-info/RECORD,,
|
|
File without changes
|
|
File without changes
|