Conceitos essenciais
Parametric FaSTrack (PF) is a framework that combines the safety guarantees of Fast and Safe Tracking (FaSTrack) with the scalability and online adaptability of DeepReach to enable efficient and guaranteed navigation in unknown environments. PF parameterizes the tracking error bound and controller by the planner's control authority, allowing it to automatically trade off between safety and navigation speed.
Resumo
The paper proposes Parametric FaSTrack (PF), a framework that combines the safety guarantees of Fast and Safe Tracking (FaSTrack) with the scalability and online adaptability of DeepReach. The key contributions are:
- Using DeepReach to approximate the Hamilton-Jacobi (HJ) value function, which improves the scalability of FaSTrack to high-dimensional systems.
- Parameterizing the tracking error bound (TEB) and controller by the planner's control authority, allowing PF to automatically trade off between safety and navigation speed.
- In open environments, PF can use a larger TEB associated with faster planning for efficiency.
- In cluttered environments, PF uses a tighter TEB and slower planning for safety.
- Providing algorithms to smoothly switch between different TEBs based on the distance to obstacles, increasing the overall navigation speed by up to 40% compared to state-of-the-art online planning methods.
The offline computation in PF involves training a parameterized value function using DeepReach, which outputs the static TEB (sTEB), dynamic TEB (dTEB), and the tracking controller. The online execution adapts the planner's control bound based on the distance to obstacles, using the sTEB and dTEB to guarantee safety while maximizing efficiency.
The paper demonstrates the effectiveness of PF through simulations of a 6D Dubin's car system and a 13D quadcopter system, showing significant improvements in navigation speed while preserving safety compared to existing methods.
Estatísticas
The system dynamics for the 6D Dubin's car example are:
˙r1 = r4 sin(r3) - upx
˙r2 = r4 cos(r3) - upy
˙r3 = ω
˙r4 = α
˙β1 = 0
˙β2 = 0
The system dynamics for the 13D quadcopter example are:
˙r1 = r2 - upx
˙r2 = g tan(r3)
˙r3 = -d1r3 + r4
˙r4 = -d0r3 + n0ux
˙r5 = r6 - upy
˙r6 = g tan(r7)
˙r7 = -d1r7 + r8
˙r8 = -d0r7 + n0uy
˙r9 = s10 - upz
˙r10 = kT uz - g
˙β1 = 0
˙β2 = 0
˙β3 = 0
Citações
"Parametric FaSTrack (PF) is a framework that combines the safety guarantees of Fast and Safe Tracking (FaSTrack) with the scalability and online adaptability of DeepReach to enable efficient and guaranteed navigation in unknown environments."
"PF parameterizes the tracking error bound (TEB) and controller by the planner's control authority, allowing it to automatically trade off between safety and navigation speed."
"The paper demonstrates the effectiveness of PF through simulations of a 6D Dubin's car system and a 13D quadcopter system, showing significant improvements in navigation speed while preserving safety compared to existing methods."