Kinodynamic Motion Planning for Collaborative Object Transportation by Multiple Mobile Manipulators

Keshab Patra,Arpita Sinha,Anirban Guha
2024-09-23
Abstract:This work proposes a kinodynamic motion planning technique for collaborative object transportation by multiple mobile manipulators in dynamic environments. A global path planner computes a linear piecewise path from start to goal. A novel algorithm detects the narrow regions between the static obstacles and aids in defining the obstacle-free region to enhance the feasibility of the global path. We then formulate a local online motion planning technique for trajectory generation that minimizes the control efforts in a receding horizon manner. It plans the trajectory for finite time horizons, considering the kinodynamic constraints and the static and dynamic obstacles. The planning technique jointly plans for the mobile bases and the arms to utilize the locomotion capability of the mobile base and the manipulation capability of the arm efficiently. We use a convex cone approach to avoid self-collision of the formation by modifying the mobile manipulators admissible state without imposing additional constraints. Numerical simulations and hardware experiments showcase the efficiency of the proposed approach.
Robotics,Multiagent Systems,Optimization and Control
What problem does this paper attempt to address?
The problem that this paper attempts to solve is: the motion planning problem when multiple Mobile Manipulators (MMRs) transport objects cooperatively in a dynamic environment. Specifically, the paper proposes a new motion planning technique to ensure that these robots can complete the transportation tasks efficiently and safely in the presence of static and dynamic obstacles. ### 1. **Problem Background** - **Requirement Motivation**: The need for autonomous transportation of large and heavy objects is very important in scenarios such as warehouses, construction sites, and disaster recovery. Multiple mobile manipulators working together can significantly improve transportation efficiency, realize large - part processing without fixtures, and support multi - task parallel operations in automobile and aerospace manufacturing. - **Shortcomings of Existing Methods**: Existing motion planning techniques have deficiencies in considering motion limitations and optimal control inputs, especially when planning collision - free paths in static and dynamic environments, it is difficult to simultaneously meet kinematic and dynamic constraints. ### 2. **Specific Problems** - **Motion Planning Challenges**: In a complex dynamic environment, how to plan a feasible and collision - free path for multiple mobile manipulators is a key issue. Especially when there are narrow areas (such as porches and corridors) in the environment, traditional random sampling methods may not be able to find a suitable path. - **Self - collision Avoidance**: When multiple mobile manipulators work together, they must avoid collisions with each other and with the transported objects. - **Combination of Global and Local Planning**: A motion planning method that can perform both global path planning and local online adjustment according to real - time environmental changes is required. ### 3. **Main Contributions of the Paper** 1. **Locally Optimal Motion Planning**: An online motion planning method based on Non - linear Model Predictive Control (NMPC) is proposed, which can plan the optimal paths for multiple mobile manipulators in static and dynamic obstacle environments, making full use of the robots' mobility and manipulation capabilities. 2. **Global Path Planning**: By selectively generating seed points in narrow areas, ensure that collision - free convex polygons are defined in these areas, thereby improving the feasibility of path planning. 3. **Self - collision Avoidance**: The convex cone geometry method is used to modify the acceptable states of each mobile manipulator to avoid self - collision without introducing additional constraint conditions. ### 4. **Solutions** - **Global Path Planning**: By defining static collision - free convex polygons in narrow areas and using non - linear constraint optimization to calculate feasible formation configurations, finally find the shortest path from the starting point to the ending point. - **Local Motion Planning**: Based on the global path as an initial guess, use the NMPC method to generate collision - free trajectories that meet kinematic and dynamic constraints in a dynamic environment. - **Self - collision Avoidance**: Ensure that robots do not self - collide when working together through the convex cone geometry method. ### 5. **Application Scenarios** This method is applicable to various scenarios where multiple mobile manipulators need to work together, such as: - **Warehouse Automation**: Efficiently transport large - scale goods. - **Construction Sites**: Transport heavy building materials. - **Disaster Recovery**: Clear large objects in the ruins. Through these improvements, the method proposed in the paper improves the reliability and efficiency of the multi - robot cooperative transportation system.