How nitin3560/twinguard works
TwinGuard is a ROS 2 trust-aware UAV autonomy framework. Its principal workflow fuses PX4 odometry (and visual-odometry diagnostics), evaluates localization integrity and authority, then exposes trust to planning and offboard supervision before commands reach PX4. Separate branches provide BehaviorTree/A* mission planning, Nav2 plugins, and dataset-driven replay with visualization. The graph combines sampled source relationships with README-documented runtime flow; unsampled wiring is not treated as inspected, and uncertain links are omitted.
Main entry points: ekf_integrity_node.cpp EKF Integrity Node · twinguard_ekf_integrity.launch.py Experiment Launches · bt_nodes.cpp BehaviorTree Mission · formation_supervisor_node.cpp Formation Supervisor
Components 19
Estimation & Integrity
- EKF Integrity Node
ros2_ws/src/twinguard_swarm_estimation_cpp/src/ekf_integrity_node.cpp - Kalman Estimator
ros2_ws/src/twinguard_swarm_estimation_cpp/src/ekf_estimator.cpp - Estimation Authority
ros2_ws/src/twinguard_swarm_estimation_cpp/src/estimation_authority_model.cpp - Visual Odometry
ros2_ws/src/twinguard_swarm_estimation_cpp/src/visual_odometry_node.cpp - Trust Scoring
ros2_ws/src/twinguard_swarm_integrity_cpp/src/trust_scorer.cpp - Hard Safety Monitor
ros2_ws/src/twinguard_swarm_integrity_cpp/src/hard_safety_monitor.cpp - Authority Aggregator
ros2_ws/src/twinguard_swarm_integrity_cpp/src/authority_aggregator.cpp
Planning & Navigation
- BehaviorTree Mission
ros2_ws/src/twinguard_swarm_planning_cpp/src/bt_nodes.cpp - A* Planner
ros2_ws/src/twinguard_swarm_planning_cpp/src/astar_planner.cpp - Integrity Costmap
ros2_ws/src/twinguard_swarm_nav2_cpp/src/integrity_costmap_layer.cpp - Trust Condition
ros2_ws/src/twinguard_swarm_nav2_cpp/src/is_agent_trustworthy.cpp
Control & Supervision
- Formation Supervisor
ros2_ws/src/twinguard_swarm_integrity_cpp/src/formation_supervisor_node.cpp - Offboard Supervisor
ros2_ws/src/twinguard_swarm_integrity_cpp/src/offboard_supervisor.cpp
Replay & Bringup
- Dataset Replay
ros2_ws/src/twinguard_dataset_replay/twinguard_dataset_replay/dataset_replay_node.py - Trust Visualizer
ros2_ws/src/twinguard_dataset_replay/twinguard_dataset_replay/trust_visualizer_node.py - Experiment Launches
ros2_ws/src/twinguard_swarm_bringup/launch/twinguard_ekf_integrity.launch.py
Other components
- Operator
- PX4 Vehicle
- Gazebo SITL
Connections 22
- Operator → Experiment Launches: starts experiments
README.md - Experiment Launches → EKF Integrity Node: launches integrity
ros2_ws/src/twinguard_swarm_bringup/launch/twinguard_ekf_integrity.launch.py - PX4 Vehicle → EKF Integrity Node: publishes odometry
ros2_ws/src/twinguard_swarm_estimation_cpp/src/ekf_integrity_node.cpp - Visual Odometry → EKF Integrity Node: sends diagnostics
ros2_ws/src/twinguard_swarm_estimation_cpp/src/ekf_integrity_node.cpp - EKF Integrity Node → Kalman Estimator: updates estimate
ros2_ws/src/twinguard_swarm_estimation_cpp/src/ekf_integrity_node.cpp - EKF Integrity Node → Estimation Authority: evaluates quality
ros2_ws/src/twinguard_swarm_estimation_cpp/src/ekf_integrity_node.cpp - EKF Integrity Node → Trust Scoring: scores residual
ros2_ws/src/twinguard_swarm_estimation_cpp/src/ekf_integrity_node.cpp - EKF Integrity Node → Hard Safety Monitor: checks override
ros2_ws/src/twinguard_swarm_estimation_cpp/src/ekf_integrity_node.cpp - EKF Integrity Node → Authority Aggregator: aggregates factors
README.md - EKF Integrity Node → Integrity Costmap: publishes trust state
README.md - EKF Integrity Node → Trust Condition: publishes trust state
README.md - EKF Integrity Node → BehaviorTree Mission: publishes trust state
README.md - BehaviorTree Mission → A* Planner: plans reroutes
ros2_ws/src/twinguard_swarm_planning_cpp/src/bt_nodes.cpp - Formation Supervisor → BehaviorTree Mission: uses mission nodes
ros2_ws/src/twinguard_swarm_integrity_cpp/src/formation_supervisor_node.cpp - Formation Supervisor → A* Planner: uses planner
ros2_ws/src/twinguard_swarm_integrity_cpp/src/formation_supervisor_node.cpp - BehaviorTree Mission → Offboard Supervisor: provides setpoints
README.md - Offboard Supervisor → PX4 Vehicle: sends setpoints
README.md - Integrity Costmap → Gazebo SITL: guides navigation
- Dataset Replay → EKF Integrity Node: replays degradation
README.md - Dataset Replay → Trust Visualizer: provides replay data
- Experiment Launches → Dataset Replay: launches replay
- Experiment Launches → Formation Supervisor: launches missions