Edge Accelerated Robot Navigation With Collaborative Motion Planning

Guoliang Li,Ruihua Han,Shuai Wang,Fei Gao,Yonina C. Eldar,Chengzhong Xu
2024-06-25
Abstract:Low-cost distributed robots suffer from limited onboard computing power, resulting in excessive computation time when navigating in cluttered environments. This paper presents Edge Accelerated Robot Navigation (EARN), to achieve real-time collision avoidance by adopting collaborative motion planning (CMP). As such, each robot can dynamically switch between a conservative motion planner executed locally to guarantee safety (e.g., path-following) and an aggressive motion planner executed non-locally to guarantee efficiency (e.g., overtaking). In contrast to existing motion planning approaches that ignore the interdependency between low-level motion planning and high-level resource allocation, EARN adopts model predictive switching (MPS) that maximizes the expected switching gain with respect to robot states and actions under computation and communication resource constraints. The MPS problem is solved by a tightly-coupled decision making and motion planning framework based on bilevel mixed-integer nonlinear programming and penalty dual decomposition. We validate the performance of EARN in indoor simulation, outdoor simulation, and real-world environments. Experiments show that EARN achieves significantly smaller navigation time and higher success rates than state-of-the-art navigation approaches.
Robotics
What problem does this paper attempt to address?
### Problems the paper attempts to solve This paper aims to solve the problem of limited computing power faced by low - cost distributed robots when navigating in complex environments. Specifically: 1. **Computing power limitations**: Low - cost robots have limited computing power, resulting in excessive computing time when navigating in crowded environments and being unable to achieve real - time obstacle avoidance. 2. **Limitations of existing methods**: Most existing motion planning methods reduce computing time from the perspective of algorithm design, such as using heuristic methods, approximation methods, parallel computing or learning techniques. However, these methods ignore the interdependence between low - level motion planning and high - level resource allocation. 3. **Requirement for real - time and efficient navigation**: In order to achieve efficient real - time navigation, a method that can dynamically switch between conservative local motion planners and aggressive edge motion planners is required to ensure safety and efficiency. ### Solutions The paper proposes **Edge Accelerated Robot Navigation (EARN)**, which achieves real - time and efficient obstacle - avoidance navigation through Collaborative Motion Planning (CMP) and Model Predictive Switching (MPS). Specific features are as follows: 1. **Collaborative Motion Planning (CMP)**: - Each robot can dynamically choose to execute a conservative motion planner (such as path following) locally to ensure safety; or execute an aggressive motion planner (such as overtaking) on the edge server to improve efficiency. - Through Model Predictive Switching (MPS), maximize the expected switching gain while considering computing and communication resource constraints. 2. **Model Predictive Switching (MPS)**: - MPS realizes the tight coupling of decision - making and motion planning through the Bilevel Mixed - Integer Nonlinear Programming (B - MINLP) algorithm and the Penalty Dual Decomposition (PDD) algorithm. - The B - MINLP algorithm is used for high - level resource management, automatically identifying robots for which switching is beneficial, and coordinating computing and communication resources. - The PDD algorithm is used for low - level motion planning, calculating collision - free trajectories, with parallel computing and convergence guarantees. ### Experimental verification The paper verifies the performance of EARN in indoor simulations, outdoor simulations and real - world environments. The experimental results show that EARN is significantly superior to existing navigation methods in terms of navigation time and success rate. ### Main contributions 1. **Propose EARN**: Based on MPS, achieve real - time and efficient navigation in dynamic environments under resource constraints. 2. **Propose B - MINLP and PDD algorithms**: Ensure smooth planner switching and real - time motion planning. 3. **Implement EARN in simulation and real - world environments**: Verify the superior performance of EARN. 4. **Performance evaluation**: Compared with multiple benchmark methods, EARN brings significant performance improvements. ### Formula summary 1. **State evolution model**: \[ s_{k,t + 1}=E_k(s_{k,t},u_{k,t}) = A_{k,t}s_{k,t}+B_{k,t}u_{k,t}+c_{k,t},\quad\forall k,t \] 2. **Conditional collision - avoidance function**: \[ \Psi(s_{k,t},o_{m,t},d_{\text{safe}}|\alpha_k)=\alpha_k(\text{dist}(s_{k,t},o_{m,t}) - d_{\text{safe}}) \] 3. **Expected switching gain**: \[ G_k(s_{k,t},\{o_{m,t}\},f_E,f_L)=\text{dist}_c(s^{[1]}_{k,H},s_{