# zju-fast-lab/fast-drone-250 architecture

> Architecture diagram of the GitHub repository zju-fast-lab/fast-drone-250, generated by GitDiagram from its file tree, README and a sample of source files (last updated 2026-10-04). It is an AI-made overview: check details against the source.

- Interactive diagram: https://gitdiagram.com/zju-fast-lab/fast-drone-250
- Repository: https://github.com/zju-fast-lab/fast-drone-250

## Overview

Fast-Drone-250 is a ROS-based autonomous quadrotor platform, combining VINS-Fusion state estimation, depth-camera mapping, Ego-Planner navigation, and PX4 flight control. Its documented operational flow brings up the camera and estimator, validates odometry and mapping, launches planning, then runs the controller for automatic takeoff and trajectory execution. The tree also includes simulation, visualization, and supporting interfaces. Some runtime modules were not sampled, so links between subsystems are shown only where the README explicitly documents them; internal edges use visible source references.

Main entry points: [`src/planner/plan_manage/src/planner_manager.cpp`](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/plan_manage/src/planner_manager.cpp) (Planner Manager), [`src/realflight_modules/VINS-Fusion/vins_estimator/src/estimator/estimator.cpp`](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/VINS-Fusion/vins_estimator/src/estimator/estimator.cpp) (VINS Estimator), [`src/realflight_modules/realsense-ros/realsense2_camera/src/base_realsense_node.cpp`](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/realsense-ros/realsense2_camera/src/base_realsense_node.cpp) (RealSense Driver), [`src/planner/plan_manage/src/ego_replan_fsm.cpp`](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/plan_manage/src/ego_replan_fsm.cpp) (Planner FSM)

## Diagram (Mermaid)

```mermaid
flowchart TD

subgraph group_sensing["Sensing and Mapping"]
  node_realsense["RealSense Driver"]
  node_gridmap["Grid Map<br/>[grid_map.cpp]"]
  node_raycast["Ray Casting<br/>[raycast.cpp]"]
  node_predictor["Object Predictor<br/>[obj_predictor.cpp]"]
end

subgraph group_estimation["State Estimation"]
  node_estimator["VINS Estimator<br/>[estimator.cpp]"]
  node_features["Feature Manager"]
  node_tracker["Feature Tracker"]
  node_camera_models["Camera Models<br/>[CameraFactory.cc]"]
  node_loop_fusion["Loop Fusion<br/>[pose_graph.cpp]"]
  node_global_fusion["Global Fusion<br/>[globalOpt.cpp]"]
end

subgraph group_planning["Planning and Trajectory"]
  node_planner_fsm["Planner FSM<br/>[ego_replan_fsm.cpp]"]
  node_planner_manager["Planner Manager"]
  node_astar["Dynamic A Star<br/>[dyn_a_star.cpp]"]
  node_bspline["B-spline Optimizer"]
  node_traj_server["Trajectory Server<br/>[traj_server.cpp]"]
end

subgraph group_flight["Flight Control"]
  node_px4fsm["PX4 Control FSM<br/>[PX4CtrlFSM.cpp]"]
  node_controller["Linear Controller<br/>[controller.cpp]"]
end

subgraph group_simulation["Simulation and Tools"]
  node_simulator["Quadrotor Simulator"]
  node_mapgen["Map Generator<br/>[maps.cpp]"]
  node_bridge["TCP ROS Bridge<br/>[bridge_node.cpp]"]
  node_visualization["Odometry Visualization"]
end

node_operator(("Operator"))
node_px4["PX4 Flight Controller"]

node_operator -->|"launches driver"| node_realsense
node_operator -->|"launches planner"| node_planner_fsm
node_operator -->|"starts takeoff"| node_px4fsm
node_realsense -.->|"provides camera data"| node_estimator
node_estimator -->|"provides odometry"| node_planner_fsm
node_realsense -.->|"provides depth input"| node_gridmap
node_planner_fsm -.->|"supplies trajectory"| node_px4fsm
node_px4fsm -.->|"computes control"| node_controller
node_controller -.->|"commands vehicle"| node_px4
node_estimator -->|"uses feature tracks"| node_features
node_features -.->|"uses parameters"| node_tracker
node_estimator -.->|"uses calibration"| node_camera_models
node_loop_fusion -.->|"fuses global pose"| node_global_fusion
node_planner_manager -.->|"queries occupancy"| node_gridmap
node_bspline -->|"checks occupancy"| node_gridmap
node_planner_manager -.->|"searches path"| node_astar
node_planner_manager -.->|"optimizes trajectory"| node_bspline
node_planner_manager -.->|"publishes trajectory"| node_traj_server
node_mapgen -.->|"supplies simulated scene"| node_simulator
node_operator -.->|"runs simulation"| node_simulator
node_simulator -.->|"publishes odometry"| node_visualization

click node_realsense "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/realsense-ros/realsense2_camera/src/base_realsense_node.cpp"
click node_gridmap "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/plan_env/src/grid_map.cpp"
click node_raycast "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/plan_env/src/raycast.cpp"
click node_predictor "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/plan_env/src/obj_predictor.cpp"
click node_estimator "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/VINS-Fusion/vins_estimator/src/estimator/estimator.cpp"
click node_features "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/VINS-Fusion/vins_estimator/src/estimator/feature_manager.cpp"
click node_tracker "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/VINS-Fusion/vins_estimator/src/featureTracker/feature_tracker.cpp"
click node_camera_models "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/VINS-Fusion/camera_models/src/camera_models/CameraFactory.cc"
click node_loop_fusion "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/VINS-Fusion/loop_fusion/src/pose_graph.cpp"
click node_global_fusion "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/VINS-Fusion/global_fusion/src/globalOpt.cpp"
click node_planner_fsm "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/plan_manage/src/ego_replan_fsm.cpp"
click node_planner_manager "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/plan_manage/src/planner_manager.cpp"
click node_astar "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/path_searching/src/dyn_a_star.cpp"
click node_bspline "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/bspline_opt/src/bspline_optimizer.cpp"
click node_traj_server "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/plan_manage/src/traj_server.cpp"
click node_px4fsm "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/px4ctrl/src/PX4CtrlFSM.cpp"
click node_controller "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/px4ctrl/src/controller.cpp"
click node_simulator "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/uav_simulator/so3_quadrotor_simulator/src/quadrotor_simulator_so3.cpp"
click node_mapgen "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/uav_simulator/mockamap/src/maps.cpp"
click node_bridge "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/rosmsg_tcp_bridge/src/bridge_node.cpp"
click node_visualization "https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/uav_simulator/odom_visualization/src/odom_visualization.cpp"

classDef toneNeutral fill:#f8fafc,stroke:#334155,stroke-width:1.5px,color:#0f172a
classDef toneBlue fill:#dbeafe,stroke:#2563eb,stroke-width:1.5px,color:#172554
classDef toneAmber fill:#fef3c7,stroke:#d97706,stroke-width:1.5px,color:#78350f
classDef toneMint fill:#dcfce7,stroke:#16a34a,stroke-width:1.5px,color:#14532d
classDef toneRose fill:#ffe4e6,stroke:#e11d48,stroke-width:1.5px,color:#881337
classDef toneIndigo fill:#e0e7ff,stroke:#4f46e5,stroke-width:1.5px,color:#312e81
classDef toneTeal fill:#ccfbf1,stroke:#0f766e,stroke-width:1.5px,color:#134e4a
class node_realsense,node_gridmap,node_raycast,node_predictor toneBlue
class node_estimator,node_features,node_tracker,node_camera_models,node_loop_fusion,node_global_fusion toneAmber
class node_planner_fsm,node_planner_manager,node_astar,node_bspline,node_traj_server toneMint
class node_px4fsm,node_controller toneRose
class node_simulator,node_mapgen,node_bridge,node_visualization,node_operator,node_px4 toneIndigo
```

## Components

### Sensing and Mapping

- [RealSense Driver](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/realsense-ros/realsense2_camera/src/base_realsense_node.cpp): `src/realflight_modules/realsense-ros/realsense2_camera/src/base_realsense_node.cpp`
- [Grid Map](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/plan_env/src/grid_map.cpp): `src/planner/plan_env/src/grid_map.cpp`
- [Ray Casting](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/plan_env/src/raycast.cpp): `src/planner/plan_env/src/raycast.cpp`
- [Object Predictor](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/plan_env/src/obj_predictor.cpp): `src/planner/plan_env/src/obj_predictor.cpp`

### State Estimation

- [VINS Estimator](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/VINS-Fusion/vins_estimator/src/estimator/estimator.cpp): `src/realflight_modules/VINS-Fusion/vins_estimator/src/estimator/estimator.cpp`
- [Feature Manager](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/VINS-Fusion/vins_estimator/src/estimator/feature_manager.cpp): `src/realflight_modules/VINS-Fusion/vins_estimator/src/estimator/feature_manager.cpp`
- [Feature Tracker](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/VINS-Fusion/vins_estimator/src/featureTracker/feature_tracker.cpp): `src/realflight_modules/VINS-Fusion/vins_estimator/src/featureTracker/feature_tracker.cpp`
- [Camera Models](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/VINS-Fusion/camera_models/src/camera_models/CameraFactory.cc): `src/realflight_modules/VINS-Fusion/camera_models/src/camera_models/CameraFactory.cc`
- [Loop Fusion](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/VINS-Fusion/loop_fusion/src/pose_graph.cpp): `src/realflight_modules/VINS-Fusion/loop_fusion/src/pose_graph.cpp`
- [Global Fusion](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/VINS-Fusion/global_fusion/src/globalOpt.cpp): `src/realflight_modules/VINS-Fusion/global_fusion/src/globalOpt.cpp`

### Planning and Trajectory

- [Planner FSM](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/plan_manage/src/ego_replan_fsm.cpp): `src/planner/plan_manage/src/ego_replan_fsm.cpp`
- [Planner Manager](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/plan_manage/src/planner_manager.cpp): `src/planner/plan_manage/src/planner_manager.cpp`
- [Dynamic A Star](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/path_searching/src/dyn_a_star.cpp): `src/planner/path_searching/src/dyn_a_star.cpp`
- [B-spline Optimizer](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/bspline_opt/src/bspline_optimizer.cpp): `src/planner/bspline_opt/src/bspline_optimizer.cpp`
- [Trajectory Server](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/plan_manage/src/traj_server.cpp): `src/planner/plan_manage/src/traj_server.cpp`

### Flight Control

- [PX4 Control FSM](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/px4ctrl/src/PX4CtrlFSM.cpp): `src/realflight_modules/px4ctrl/src/PX4CtrlFSM.cpp`
- [Linear Controller](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/realflight_modules/px4ctrl/src/controller.cpp): `src/realflight_modules/px4ctrl/src/controller.cpp`

### Simulation and Tools

- [Quadrotor Simulator](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/uav_simulator/so3_quadrotor_simulator/src/quadrotor_simulator_so3.cpp): `src/uav_simulator/so3_quadrotor_simulator/src/quadrotor_simulator_so3.cpp`
- [Map Generator](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/uav_simulator/mockamap/src/maps.cpp): `src/uav_simulator/mockamap/src/maps.cpp`
- [TCP ROS Bridge](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/planner/rosmsg_tcp_bridge/src/bridge_node.cpp): `src/planner/rosmsg_tcp_bridge/src/bridge_node.cpp`
- [Odometry Visualization](https://github.com/zju-fast-lab/fast-drone-250/blob/master/src/uav_simulator/odom_visualization/src/odom_visualization.cpp): `src/uav_simulator/odom_visualization/src/odom_visualization.cpp`

### Other components

- **Operator**
- **PX4 Flight Controller**

## Connections

- Operator → RealSense Driver: launches driver
- Operator → Planner FSM: launches planner
- Operator → PX4 Control FSM: starts takeoff
- RealSense Driver → VINS Estimator: provides camera data
- VINS Estimator → Planner FSM: provides odometry
- RealSense Driver → Grid Map: provides depth input
- Planner FSM → PX4 Control FSM: supplies trajectory
- PX4 Control FSM → Linear Controller: computes control
- Linear Controller → PX4 Flight Controller: commands vehicle
- VINS Estimator → Feature Manager: uses feature tracks (evidence: `src/realflight_modules/VINS-Fusion/vins_estimator/src/estimator/feature_manager.cpp`)
- Feature Manager → Feature Tracker: uses parameters
- VINS Estimator → Camera Models: uses calibration
- Loop Fusion → Global Fusion: fuses global pose
- Planner Manager → Grid Map: queries occupancy
- B-spline Optimizer → Grid Map: checks occupancy (evidence: `src/planner/bspline_opt/src/bspline_optimizer.cpp`)
- Planner Manager → Dynamic A Star: searches path
- Planner Manager → B-spline Optimizer: optimizes trajectory
- Planner Manager → Trajectory Server: publishes trajectory
- Map Generator → Quadrotor Simulator: supplies simulated scene
- Operator → Quadrotor Simulator: runs simulation
- Quadrotor Simulator → Odometry Visualization: publishes odometry
