Function simulate_trajectory_following 

pub fn simulate_trajectory_following(
    waypoints: &[Vector3<f64>],
    config: &SimulationConfig,
) -> SimulationRecord

Run the full trajectory-following simulation.

The quadrotor starts at the first waypoint and follows a closed loop through all waypoints for config.n_loops complete passes.

Returns a SimulationRecord containing the full state history.