Together We Rise: Optimizing Real-Time Multi-Robot Task Allocation using Coordinated Heterogeneous Plays Aritra Pal, Anandsingh Chauhan, Mayank Baranwal Abstract . Efficient task allocation among multiple robots is crucial for optimizing productivity in modern warehouses, particularly in response to the increasing demands of online order fulfillment. This paper addresses the real-time multi-robot task allocation (MRTA) problem in dynamic warehouse environments, where tasks emerge with specified start and end locations. The objective is to minimize both the total travel distance of robots and delays in task completion, while also considering practical constraints such as battery management and collision avoidance. We introduce MRTAgent , a dual-agent Reinforcement Learning (RL) framework inspired by self-play, designed to optimize task assignments and robot selection to ensure timely task execution. For safe navigation, a modified linear quadratic controller (LQR) approach is employed. To the best of our knowledge, MRTAgent is the first framework to address all critical aspects of practical MRTA problems while supporting continuous robot movements. Y. Vorobeychik, S. Das, A. Nowé (eds.) Conference: Proc. of the 24th International Conference on Autonomous Agents and Multiagent Systems (AAMAS 2025); May 19 – 23, 2025; Detroit, Michigan, USA <> AAAI Track 1. Introduction Cooperative multi-robot systems are increasingly being utilized across various domains, including transportation and logistics ( Farinelli et al., 2017 ) , search and rescue operations ( Queralta et al., 2020 ) , environmental monitoring ( Ma et al., 2018 ) , precision agriculture ( Dutta et al., 2021 ) , construction ( Sartoretti et al., 2019 ) , and warehouse automation ( Kartal et al., 2016 ; Gini, 2017 ) . These systems, characterized by the collaboration of multiple robots to achieve shared objectives, offer substantial benefits such as enhanced scalability & efficiency, and greater fault tolerance, making them indispensable in dynamic environments. Intricacies of Warehouse Management: Automating warehouse operations with multi-robot systems presents a unique set of challenges, stemming from the complexities of spatial layouts, diverse task demands, varying robot capabilities, and the critical need for safe robotic navigation ( Bolu and Korçak, 2021 ; Wilson et al., 2021 ) . These challenges can be broadly divided into three key objectives: (a) Task Allocation , (b) Real-Time Robot Assignment , and (c) Path Planning . While these objectives are interrelated, each introduces distinct sub-problems that must be resolved to achieve optimal warehouse performance. In a dynamic warehouse setting, real-time task generation is vital because tasks cannot be fully anticipated in advance. This unpredictability complicates the planning process, necessitating the prioritization of tasks based on their arrival times, required completion deadlines, and the need to minimize the total travel distances of robots while balancing the demands of ongoing tasks. Moreover, the immediate and continuous allocation of robots to tasks demands seamless coordination, regardless of whether the robots are currently available or occupied. This emphasizes the need for real-time synchronization across multiple objectives, all while adhering to various physical and operational constraints. For example, effective path planning requires the creation of collision-free routes that navigate around static obstacles and account for the movements of other robots. Furthermore, it is crucial to consider the physical dynamics of the robots, such as acceleration, deceleration, and maneuverability-along with other practical considerations, such as their state-of-charge (SOC). These factors, often overlooked in existing warehouse management literature, are essential to the planning process. The intricate interdependence of these challenges highlights the need for a sophisticated and adaptable multi-robot framework. Such a framework must systematically address the complexities of task allocation, real-time robot assignment, and path planning within the constantly changing environment of an automated warehouse. Neglecting the interconnected nature of these tasks often leads to sub-optimal performance and inefficiencies, undermining the overall effectiveness of warehouse operations. Figure 1. Self-play inspired bi-level reinforcement learning agent for assigning robots to tasks within a dynamic environment Statement of Contributions: In this study, we present a self-play inspired novel framework, MRTAgent , which employs a bi-level RL strategy inspired to tackle the challenges of multi-task selection and multi-robot allocation. MRTAgent is designed to handle real-time task selection, dynamically allocate tasks to robots, and ensure safe navigation, all while accounting for critical constraints such as robot dynamics, charging needs, and specific task requirements. MRTAgent consists of three key components: (a) Task selection agent (Planner) to prioritize a task queued in the task buffer, (b) Robot selection agent (Executor) to allocate a robot to the recommended task, and (c) Navigator to plan collision-free trajectories of robots while adhering to physical and SOC constraints. The framework is highlighted in Figure 1 . The primary contributions of our work can be summarized as follows: Coordinating RL agents for task and robot selections: Existing approaches for MRTA, such as in ( Agrawal et al., 2022 ) , primarily emphasize task selection with the assumption that the chosen task will always be assigned to an available (unoccupied) robot. Although this assumption simplifies the problem, it is highly sub-optimal. For instance, a robot might become available at a location far from the selected task’s origin, while another robot in close proximity to the task origin may soon become available. We alleviate this by introducing heterogeneous RL agents, one each for task selection and robot allocation. These RL agents are trained concurrently in our framework in a self-play manner, gradually developing the coordination between the two. Collision-free, physics-constrained multi-robot navigation: Practical robots do not operate in a grid world environment, allowing for sudden grid changes in any of the feasible directions. However, robots have some underlying dynamics and navigate continuously. Instead of using collision-free navigation algorithms applicable to grid worlds, we model these robots as double integrator systems and use linear quadratic regulators (LQRs) with artificial potential field (APF) for collision-free multi-robot navigation. An end-to-end framework for MRTA: To the best of our knowledge, our approach is the first to consider multiple echelons of MRTA, requiring decision-making at each stage. We address every aspect of MRTA, including robot allocation even when robots are occupied, accounting for their SOC, underlying dynamics, and ensuring collision-free navigation under actuation constraints. We further validate our trained framework on datasets with distributional shifts, varying numbers of robots and tasks. 2. Related Works Efficient MRTA and path planning are crucial for optimizing order fulfillment, resource management, and obstacle-free navigation in industrial environments such as automated warehouses and manufacturing plants. These processes ultimately enhance overall productivity, which has made MRTA a focal point of research over the past two decades. Research efforts in this area range from heuristic-driven approaches to contemporary learning-based methods ( Khamis et al., 2015 ) . Early work by ( Gerkey and Mataric, 2003 ) provided a comparative analysis of state-of-the-art (SOTA) multi-robot coordination strategies within specific domain contexts. Current MRTA research primarily focuses on two key elements: (a) model-driven optimization, as demonstrated by ( Wei et al., 2020 ) , and (b) communication-efficient decentralized algorithms, as seen in ( Chen et al., 2021 ; Agrawal et al., 2022 ) . The problem can also be framed as a multi-agent pickup and delivery (MAPD) challenge, which has been studied through both distributed and centralized approaches ( Ma et al., 2017 ; Liu et al., 2019 ; Salzman and Stern, 2020 ; Xu et al., 2022 ) . However, most existing research in this area has concentrated on offline MAPD, whereas our approach emphasizes learning-based methods for online task allocation. This focus is driven by the need for reliable solutions in dynamic environments, where continually solving optimization problems can be computationally intensive. Recent advancements in reinforcement learning (RL) for solving complex dynamic challenges have led to a trend toward learning-based approaches for managing warehouse complexities ( Yang et al., 2020 ; Agrawal et al., 2022 ; Agrawal et al., 2023 ) . These learning strategies address various aspects of end-to-end warehouse management. For instance, ( Yang et al., 2020 ) proposed a Q-learning framework to generate collision-free, secure paths for multi-robot systems. Conversely, the RL frameworks in ( Agrawal et al., 2022 ; Agrawal et al., 2023 ) focus on optimal task selection but neglect task-to-robot assignment, assuming constant robot availability post-selection. Additionally, these works leverage A^{*} coupled with optimal reciprocal collision avoidance ( Alonso-Mora et al., 2013 ) for collision-free navigation at the low-level path planning stage. However, as previously discussed, most SOTA learning-based warehouse management approaches, including those mentioned, overlook a key benefit of RL: the ability to integrate multiple levels of warehouse management, and consideration of robots’ constraints during the training phase of the RL agent. For instance, the learned policy in ( Agrawal et al., 2022 ; Agrawal et al., 2023 ) is limited in its applicability to realistic warehouse scenarios due to the neglect of constraints related to robot availability and SOC. Moreover, these approaches often aim for a seamless sequential flow of tasks without considering their generation times. Similarly, ( Papoudakis et al., 2021 ) utilizes a cooperative multi-agent RL framework under the assumption that robots never collide. Much of the prior work also neglects the complexities of robot dynamics in MRTA for warehouse settings, often simplifying robots to point objects or solving problems in basic square grid environments, without accounting for robot acceleration, deceleration, and collision risks during path planning ( Pal et al., 2024 ) . In our study, we address these gaps by incorporating task arrival times to ensure timely task execution while considering practical factors such as robot availability, SOC, robot dynamics, and collision-free path generation. Our framework also demonstrates robust performance under distribution shifts and with variable-sized fleets. Our MRTAgent addresses these limitations by integrating robot dynamics into the navigation planning process using a linear quadratic regulator (LQR)-based navigation path algorithm within the RL agent framework. This ensures that path planning is both effective and collision-free. Additionally, we design a reward structure that balances prompt task allocation with the shortest possible execution duration for allocated tasks. This approach ensures competitive runtime during the deployment phase, facilitating real-time task selection and robot allocation, and collision-free navigation considering physical dynamics through proposed MRTAgent . 3. Preliminaries 3.1. States, Actions and Rewards The problem of MRTA can be modeled as a Markov Decision Process (MDP) ( Puterman, 1990 ) . An MDP is denoted by the tuple \langle\mathcal{S},\mathcal{A},\mathcal{P}_{\mathcal{A}},r\rangle , where \mathcal{S} and \mathcal{A} represent the finite sets of states and actions, respectively. For any s,s^{\prime}\in S , the transition probability from state s to state s^{\prime} under the action a\in A is denoted by p_{a}(s,s^{\prime})\in P_{A} . Finally, the step reward associated with each state-action pair (s,a) is depicted by r(s,a) . Below, we summarize the set of all possible states, actions, and rewards in the context of the MRTAgent validated within warehouse environment settings. States : At each time step, the warehouse environment is characterized by a comprehensive state that includes detailed information about both tasks and robots. Incoming tasks are immediately stored in a buffer, forming a limited-size look-ahead (LA) queue in a First-In-First-Out(FIFO) manner. The Tasks RL agent, referred to as the Planner , is trained to optimally select tasks from this queue based on the current state of the environment. Simultaneously, the Robot RL agent, referred to as the Executor , responsible for executing tasks, selects most suitable robots to complete them. The states of the Planner and Executor consist of the features related to tasks in the LA (denoted by \mathcal{P} ) as well as the set of robots ( \mathcal{R} ). Each agent’s state, denoted as s_{t}\in\mathcal{S} at time-step t , encompasses the following components: (a) origin coordinates of tasks \{o_{i}\} , (b) destination coordinates of tasks \{d_{i}\} , (c) euclidean distance information between task origin and destination \{k_{i}\} , (d) timestamp of task appearance in the LA queue \{l_{i}\} , (e) robot coordinates \{p_{j}\} , (f) robot availability and the anticipated time for ongoing task completion \{r_{j}\} , (g) robot charge percentage \{c_{j}\} . Features (a)-(d) are task-specific and collectively have a dimensionality of 6 for each task. Conversely, features (e)-(g) are linked to robot-specific attributes (dim. = 4 for each robot). Actions : The MRTAgent consists self-play inspired bi-level RL agent; planner and executor. The goal of the planner is to enhance task assignment, thereby minimizing total operational time. The planner’s actions involve systematically selecting tasks from the queue while the executor focuses on robot allocation, with the objective of optimally assigning robots to the selected tasks to reduce overall operational expenses, and task execution delays. Thus, the actions executed in the environment consist of the selected task and its corresponding robot pair. Rewards : The step reward attributed to a task-action pair encompasses two distinct components. The initial component is calculated based on the time it takes for the robot to travel from its current position to the task’s starting point, termed travel time to origin (TRTO). The second component is the time gap between task arrival in the LA and the robot’s initiation of execution, denoted as the total time gap for the task (TTGT). Let \left(x_{o_{i}},y_{o_{i}}\right) and \left(x_{d_{i}},y_{d_{i}}\right) represent the origin and destination coordinates of the i^{th} -indexed task. Similarly, (x_{r_{j}},y_{r_{j}}) indicates the current position of robot j , which can vary based on whether the robot is idle, performing tasks, or at a charging location for recharging if needed. Additionally, we introduce t_{\text{stamp}_{i}} and t_{\text{exec}_{i}} to denote the time when task i appears in the task allocation (referred to as LA) and the time at which its execution begins, respectively. In each decision-making step, we use the variable allotT to signify the index of the selected task which then gets assigned to a robot selR . Furthermore, we utilize the function d[(x_{a},y_{a}),(x_{b},y_{b})] to calculate the distance between two points (x_{a},y_{a}) and (x_{b},y_{b}) within our system. The step reward for training the PPO agent is as follows: (1) \displaystyle R_{\text{step}} \displaystyle= \displaystyle-d[(x_{r_{\text{selR}}},y_{r_{\text{selR}}}),(x_{o_{\text{allotT}}},y_{o_{\text{allotT}}})] \displaystyle-\alpha*(t_{{\text{exec}}_{\text{allotT}}}-t_{{\text{stamp}}_{\text{allotT}}}) The coefficient \alpha represents positive constant. The first term in ( 1 ) corresponds to TRTO, while the second term is associated with TTGT. This reflects the principle that tasks should not remain unattended for too long. 4. Our approach Figure 2. Self-Play Motivated Bi-level RL Agent Architecture with trainable weights denoted by \{W_{k},W_{k}^{\prime}\} In this section, we introduce MRTAgent , a novel self-play-inspired bi-level RL framework (see Figure 2 ) designed to optimize MRTA for various industrial tasks. The MRTAgent is validated in warehouse environments scenario and comprises two RL agents: (a) Planner, and (b) Executor. Tasks are generated in real-time and initially populate a main task buffer. The planner has access to a small LA queue of tasks. When a task from LA queue is assigned to a robot for execution, a new task from the buffer is moved into the LA queue, making it available for selection by the Planner. If no new tasks are available in the buffer to replenish the LA queue, task with the longest duration in the LA queue is duplicated to maintain a consistent queue length, thereby increasing its likelihood of being selected by the Planner in subsequent steps. In the exceptional scenario where both the LA queue and the task buffer are empty, MRTAgent waits for a task to appear in the environment. The action selection process operates across three hierarchical levels: Task Selection: At each instant t , the Planner selects a task from the LA queue for assignment to one of the robots, guided by the current state of the environment. Robot Allocation: Upon task selection, the Executor identifies the most suitable robot for task execution. This decision considers the positions of all robots after completing their current assignments, availability and SOC. Notably, the Executor does not wait for robots to become available before making robot allocations, as the state information includes time markers indicating when robots will be free. Navigation: To guide the robots’ movement, a linear quadratic regulator (LQR) based controller, augmented with potential functions for coordinated collision avoidance, considering all its dynamics is employed. This algorithm directs the robot from its current position to the task’s starting point and subsequently to the destination, ensuring collision avoidance with moving obstacles. 4.1. MRTAgent framework Both Planner and Executor agents of the MRTAgent utilize Proximal Policy Optimization (PPO) algorithm ( Schulman et al., 2017 ) , with their architectures depicted in Figure 2 . Both the agents are trained using a self-play inspired strategy, where one agent is actively trained while the other operates in evaluation mode, alternating every 40 episodes. This concurrent training framework ensures coordination between the two agents, facilitating efficient convergence and optimization of both the task selection and robot allocation processes. 4.2. Neural Network Architecture and Training Planner and executor both employs a similar novel PPO-based framework to facilitate online task selection and robot allocation. This model architecture inspired from ( Agrawal et al., 2023 ) is distinctly structured into three core segments (see Figure 2 ). The first segment involves the procedure of feature extraction, particularly focusing on attributes related to robots and tasks. The embedding for robot attributes is created using a sequence of four linear layers of dimensions [4, 16, 16, 1]. Concurrently, embeddings related to task attributes are generated using a similar sequence of four linear layers of dimensions [6, 16, 16, 1]. Let F_{j}^{R} and F_{i}^{P} represent the feature vectors for the robot j\in\mathcal{R} and the i th-task for the planner and executor, then the associated embeddings are defined as: \displaystyle E_{i}^{P} \displaystyle= \displaystyle W_{P2}*\text{ReLU}(W_{P1}*F_{i}^{P}) \displaystyle{E}_{j}^{\prime R} \displaystyle= \displaystyle W_{R2}^{\prime}*\text{ReLU}(W_{R1}^{\prime}*F_{j}^{R}) The second module transforms the extracted embeddings by concatenating the embeddings of robots and tasks for both planner and executor. Subsequently, the concatenated feature is channelled through a linear layer consisting 48 input neurons and 8 output neurons with ReLU activation. \displaystyle a_{i}^{P} \displaystyle= \displaystyle\text{Sigmoid}(W_{P4}*\text{Tanh}(W_{P3}*E_{i}^{P})) \displaystyle a_{j}^{\prime R} \displaystyle= \displaystyle\text{Sigmoid}(W_{R4}^{\prime}*\text{Tanh}(W_{R3}^{\prime}*E_{j}^{\prime R})) \displaystyle{\pi^{\text{planner}}} \displaystyle= \displaystyle\left(\sum{E_{j}^{R}*a_{j}^{R}},\sum{E_{i}^{P}*a_{i}^{P}},E_{i}^{P}\right) \displaystyle{\pi^{\text{executor}}} \displaystyle= \displaystyle\left(\sum{E_{j}^{\prime R}*a_{j}^{\prime R}},\sum{E_{i}^{\prime P}*a_{i}^{\prime P}},E_{j}^{\prime R}\right) Final layer comprising a linear layer, this element operates with 8 input neurons and 1 output neuron. \begin{split}Task^{Allocated}&=\text{Categorical}\left(W_{2}*\text{ReLU}(W_{1}*\pi^{\text{planner}})\right)\\ Robot^{Allocated}&=\text{Categorical}\left(W^{\prime}_{2}*\text{ReLU}(W^{\prime}_{1}*\pi^{\text{executor}})\right)\end{split} Algorithm 1 MRTAgent Initialize Planner & Executor policy parameters \theta_{P0} , \theta_{E0} and value function parameters \phi_{P0} , \phi_{E0} respectively. for itr=0,1,2,\cdots K_{1} do for episodes k=0,1,2,\cdots K_{2} do Step t=0 State s_{t}\coloneq\{(o_{i},d_{i},k_{i},l_{i})_{\forall i\in\mathcal{P}},(p_{j},r_{j},c_{j})_{\forall j\in\mathcal{R}}\} Each robot j\in\mathcal{R} is executing a task (o_{j},d_{j}) while True do Update p_{j} \forall j\in\mathcal{R} using LQR with APF if p_{j}==d_{j} then if c_{j}< threshold for some j\in\mathcal{R} then Robot j navigates to nearest available charging dock for recharging. end if if itr is even then run Planner policy \pi_{Pk}=\pi(\theta_{Pk}) in the environment to select a task i\in\mathcal{P} . Executor policy takes state s_{t} as input and allots a robot j\in\mathcal{R} . else Planner policy takes state s_{t} as input and selects a task i\in\mathcal{P} . run Executor policy \pi_{Ek}=\pi(\theta_{Ek}) to allocate a robot j\in\mathcal{R} . end if end if t\leftarrow t+1 end while if itr is even then Collect set of trajectories \mathcal{D}_{Pk} Compute rewards-to-go \hat{R_{Pt}} Compute advantage estimates \hat{A_{Pt}} based on the current value function V_{\phi_{Pk}} Update policy by maximizing PPO-Clip obj.: \displaystyle\theta_{Pk+1} \displaystyle=\mathop{\arg\max\!}\limits_{\theta}\frac{1}{|\mathcal{D}_{Pk}|T}\!\!\!\sum\limits_{\tau\in\mathcal{D}_{Pk}}\!\sum\limits_{t=0}^{T}\!\min\biggl(\!\frac{\pi_{\theta}(a_{t}|s_{t})}{\pi_{\theta_{Pk}}\!(a_{t}|s_{t})} \displaystyle\qquad A^{\pi_{\theta_{Pk}}}(s_{t},a_{t}),g(\epsilon,A^{\pi_{\theta_{Pk}}}(s_{t},a_{t}))\biggr) via stochastic gradient ascent with Adam; Fit value function by regression on MSE: \phi_{Pk+1}=\mathop{\arg\min}\limits_{\phi}\frac{1}{|\mathcal{D}_{Pk}|T}\!\!\!\sum\limits_{\tau\in\mathcal{D}_{Pk}}\!\sum\limits_{t=0}^{T}\biggl(\!V_{\phi}(s_{t})-\hat{R_{Pt}}\!\biggr)^{2} via gradient descent else Update \theta_{Ek} \& \phi_{Ek} as above end if end for end for 4.3. Multi-Robot Navigation Algorithm: LQR with Artificial Potential Field Linear Quadratic Regulator (LQR) is an optimal control strategy used to determine the control inputs that minimize a quadratic cost function over time for a linear system. It is widely used in control engineering to stabilize systems and optimize performance by balancing different aspects of system behavior, like minimizing energy use, overshoot, or settling time ( Kirk, 2004 ) . When modeling robot dynamics, a common simplification is to treat the robot as a double-integrator system. This model is particularly relevant for systems where the primary concern is controlling the position and velocity of the robot ( Spong et al., 2020 ) . Consequently, state of robot i is typically represented by its position p_{i}(t)=(x_{i}(t),y_{i}(t)) and velocity v_{i}(t) , with the equations of motion represented as: \displaystyle\dot{p}_{i}(t)=v_{i}(t),\ \ \ \dot{v}_{i}(t)=u_{i}(t). Here u_{i}(t)=(u_{i_{x}}(t),u_{i_{y}}(t)) is the control input, which directly influences the acceleration. Here, complete state of the i^{\text{th}} -robot is represented as: z_{i}(t)=(p_{i}(t),v_{i}(t)) . Applying LQR to this model involves designing a controller that minimizes deviations from a desired trajectory while controlling the velocity and ensuring smooth acceleration. To extend LQR for multi-robot path planning and collision avoidance, the state and control matrices are expanded to accommodate multiple robots. Each robot is controlled using an individual LQR controller within this collective framework, allowing for the independent regulation of position and velocity while minimizing a global cost function that balances state deviations and control effort. For collision avoidance, an artificial potential field (APF) method is employed ( Park et al., 2020 ) . This approach introduces repulsive forces between robots when they come into close proximity, ensuring safe inter-robot distances. These repulsive forces are integrated into the control law, enabling the robots to avoid collisions while continuing to track their desired trajectories. This combined LQR-APF approach provides an effective solution for coordinating multiple robots in dynamic environments. More formally, we consider a system with N robots, each modeled as a double-integrator in 2D space. The dynamics of the overall system is given by: \displaystyle\dot{\mathbf{z}}(t)=A_{\text{multi}}\mathbf{z}(t)+B_{\text{multi}}\mathbf{u}(t),\quad\text{with} \displaystyle\mathbf{z}(t)=\left[\!\!\begin{array}[]{c}p_{1}(t)\\ v_{1}(t)\\ \vdots\\ p_{N}(t)\\ v_{N}(t)\end{array}\!\!\right] \displaystyle,\mathbf{u}(t)=\left[\!\!\begin{array}[]{c}u_{1}(t)\\ \vdots\\ u_{N}(t)\end{array}\!\!\right] \displaystyle A_{\text{multi}}=I_{N}\otimes\left[\!\!\begin{array}[]{cccc}0&0&1&0\\ 0&0&0&1\\ 0&0&0&0\\ 0&0&0&0\end{array}\!\!\right] \displaystyle,B_{\text{multi}}=I_{N}\otimes\left[\!\!\begin{array}[]{cc}0&0\\ 0&0\\ 1&0\\ 0&1\end{array}\!\!\right], where I_{N} is the identity matrix of size N , and \otimes denotes the Kronecker product. The objective of LQR is to minimize the following quadratic cost function: \displaystyle J=\int\limits_{0}^{\infty}(\mathbf{z}(t)^{\intercal}Q\mathbf{z}(t)+\mathbf{u}(t)^{\intercal}R\mathbf{u}(t))dt, where Q and R are weighting matrices that penalize deviations from the desired state and control effort, respectively. The optimal control input that minimizes the cost function is given by \mathbf{u}(t)=-K(\mathbf{z}(t)-\mathbf{z}_{\text{des}}) , where K is the LQR gain matrix, computed as K=R^{-1}B_{\text{multi}}^{\intercal}P , and \mathbf{z}_{\text{des}} represents the target positions and velocities. Here P is the solution to the continuous-time algebraic Riccati equation (CARE): \displaystyle A_{\text{multi}}^{\intercal}P+PA_{\text{multi}}-PB_{\text{multi}}R^{-1}B_{\text{multi}}^{\intercal}P+Q=0. In addition, we employ APF method that introduces a potential field around each robot that creates repulsive forces to avoid collisions. The repulsive potential between robots i and j is given by: \displaystyle U_{\text{rep},ij}(z_{i},z_{j})=\left\{\begin{array}[]{cc}\frac{1}{2}k_{\text{rep}}\left(\frac{1}{d_{ij}}-\frac{1}{d_{\min}}\right)^{2}&\text{if}\quad d_{ij}