Swarm Control with RRT-APF Planning and FNN Task Allocation Tested on Mobile Differential Platform
Abstract
1. Introduction
2. Materials and Methods
2.1. Problem Statement
- —Cartesian coordinates of the robot,
- —Rotation around the Y-axis,
- —Dimensions of the robot,
- —Instantaneous velocity,
- —Instantaneous angular velocity,
- E—Effector type, varying by application,
- —State of Charge, representing the battery percentage.
2.2. Performance Indicators
2.2.1. Perfomance Indicator
- The number of packages transported within a given time span,
- The amount of time required to transport a certain number of packages.
2.2.2. General Effectiveness Indicator
- and —Scaling factors that weight time and energy, respectively,
- and —Time and energy consumed by robot to complete task ,
- and —Maximum expected time and energy, obtained through testing across n possible path generations.
2.2.3. Contribution Indicator
2.2.4. Scalability Limit Indicator
- The performance increases or remains stable with the addition of new agents:
- The performance gain from adding new agents exceeds the average performance per agent:
- A is the total available operational area,
- is the fraction of area occupied by obstacles (obstacle area density),
- is the average area required per robot, including space needed for safe operation.
2.3. Task Allocation
- (Input Layer): The input vector , where corresponds to the number of input features. Specifically, corresponds to the dataset variables defined in Table 1. All input features are normalized to the range to ensure uniform scaling across the input space.
- (Hidden Layers): The architecture includes four fully connected hidden layers with neuron counts , respectively. The ReLU activation function was selected due to its efficiency and sparse activation properties.
- (Output Layer): The output layer produces a single scalar value representing the suitability score for robot on task . The output value is constrained to the unit interval using a sigmoid activation function.
Dataset Example Scenario | |||
---|---|---|---|
Index | Data | Value | Description |
0 | agent-X | 266.62 | X coordinate of agent in Cartesian system within the simulation |
1 | agent-Y | 252.20 | Y coordinate of agent in Cartesian system within the simulation |
2 | agent-Effector | 4 | Effector technology index within the swarm equipped by agent |
3 | agent-Energy | 7624 | Energy (Joules) available in the agent’s power system (battery) |
4 | agent-L | 100 | Length of agent’s frame |
5 | agent-W | 100 | Width of agent’s frame |
6 | task-X | 34.59 | X coordinate of task in Cartesian system within simulation |
7 | task-Y | 76.72 | Y coordinate of task in Cartesian system within simulation |
8 | task-Effector | 4 | Effector technology index within the swarm required for task completion |
9 | distance-metric | 290.91 | Distance between task and agent: |
10 | suitability-score | 0.84 | Suitability score—labeled by task effectivity, calculated by Equation (6) |
2.4. Path Planning
2.4.1. Global Path Planning
- —Repulsive force generated by obstacles to prevent collisions,
- —Attractive force generated by the target position to guide the robot toward the goal.
2.4.2. Hybrid RRT-APF Approach
- —nearest existing node in the RRT tree,
- —fixed step size for tree expansion,
- —resultant force computed from repulsive and attractive field contributions.
- Reduced computational overhead—The direct correction of RRT nodes using APF reduces the need for post-processing and improves real-time performance.
- Improved path quality—The APF adjustment leads to smoother and more obstacle-aware paths, especially in confined environments.
- Reduced collision rate—Early rejection of infeasible nodes by the APF prevents excessive tree expansion in complex areas, improving the overall search efficiency.
Algorithm 1 RRT-APF Path Generation |
|
2.4.3. MAPF Approach
Algorithm 2 MAPF Collision Prediction |
|
2.5. Experimental Hardware
2.5.1. Kinematic Model
2.5.2. Structural Design
2.5.3. Electronic Design
2.5.4. Effector
3. Results
3.1. Neural Network Performance
3.2. Controller Evaluation Under Obstacle Density Variations
3.3. Controller Evaluation Under Robot Density Variations
3.4. Path Generation Failures Due to Density
3.5. Analysis of KPI Effectiveness Metric
3.6. Experimental Agent Precision Analysis
4. Discussion
Author Contributions
Funding
Data Availability Statement
Conflicts of Interest
References
- Shahzad, M.M.; Saeed, Z.; Akhtar, A.; Munawar, H.; Yousaf, M.H.; Baloach, N.K.; Hussain, F. A Review of Swarm Robotics in a NutShell. Drones 2023, 7, 269. [Google Scholar] [CrossRef]
- Naysmith, C. Amazon Grows to over 750,000 Robots as World’s Second-Largest Private Employer Replaces over 100,000 Humans. 2024. Available online: https://finance.yahoo.com/news/amazon-grows-over-750-000-153000967.html (accessed on 13 April 2025).
- Ajeil, F.H.; Ibraheem, I.K.; Azar, A.T.; Humaidi, A.J. Grid-Based Mobile Robot Path Planning Using Aging-Based Ant Colony Optimization Algorithm in Static and Dynamic Environments. Sensors 2020, 20, 1880. [Google Scholar] [CrossRef] [PubMed]
- Ou, Y.; Fan, Y.; Zhang, X.; Lin, Y.; Yang, W. Improved A* Path Planning Method Based on the Grid Map. Sensors 2022, 22, 6198. [Google Scholar] [CrossRef] [PubMed]
- Bogatarkan, A. Flexible and Explainable Solutions for Multi-Agent Path Finding Problems. Electron. Proc. Theor. Comput. Sci. 2021, 345, 240–247. [Google Scholar] [CrossRef]
- Stern, R. Multi-Agent Path Finding—An Overview. In Artificial Intelligence; Springer: Berlin/Heidelberg, Germany, 2022; pp. 96–115. [Google Scholar]
- Vachálek, J.; Bartalský, L.; Rovný, O.; Šišmišová, D.; Morháč, M.; Lokšík, M. The digital twin of an industrial production line within the industry 4.0 concept. In Proceedings of the 2017 21st International Conference on Process Control (PC), Strbske Pleso, Slovakia, 6–9 June 2017; pp. 258–262. [Google Scholar] [CrossRef]
- Koren, Y.; Heisel, U.; Jovane, F.; Moriwaki, T.; Pritschow, G.; Ulsoy, G.; Van Brussel, H. Reconfigurable Manufacturing Systems. CIRP Ann. 1999, 48, 527–540. [Google Scholar] [CrossRef]
- Avhad, A.; Schou, C.; Arnarson, H.; Madsen, O. Demonstrating a Swarm Production lifecycle: A comprehensive multi-robot simulation approach. J. Manuf. Syst. 2025, 79, 484–503. [Google Scholar] [CrossRef]
- Dias, M.; Simmons, R. A market-based approach to multirobot coordination. Int. J. Robot. Res. 2005, 25, 277–292. [Google Scholar]
- Gerkey, B.P.; Mataric, M.J. Sold!: Auction methods for multirobot coordination. IEEE Trans. Robot. Autom. 2002, 18, 758–768. [Google Scholar] [CrossRef]
- Google OR-Tools. Operations Research Tools: Routing Library. 2025. Available online: https://developers.google.com/optimization (accessed on 30 May 2025).
- Milner, E.; Sooriyabandara, M.; Hauert, S. Swarm Performance Indicators: Metrics for Robustness, Fault Tolerance, Scalability and Adaptability. arXiv 2023, arXiv:2311.01944. [Google Scholar]
- Hamann, H.; Reina, A. Scalability in Computing and Robotics. arXiv 2020, arXiv:2006.04969. [Google Scholar] [CrossRef]
- Harwell, J.; Gini, M. Improved Swarm Engineering: Aligning Intuition and Analysis. arXiv 2021, arXiv:2012.04144. [Google Scholar]
- Kingma, D.P.; Ba, J. Adam: A Method for Stochastic Optimization. arXiv 2017, arXiv:1412.6980. [Google Scholar]
- Sánchez-Ibáñez, J.R.; Pérez-del Pulgar, C.J.; García-Cerezo, A. Path Planning for Autonomous Mobile Robots: A Review. Sensors 2021, 21, 7898. [Google Scholar] [CrossRef]
- Cheng, C.; Zhang, H.; Sun, Y.; Tao, H.; Chen, Y. A cross-platform deep reinforcement learning model for autonomous navigation without global information in different scenes. Control Eng. Pract. 2024, 150, 105991. [Google Scholar] [CrossRef]
- Qin, H.; Shao, S.; Wang, T.; Yu, X.; Jiang, Y.; Cao, Z. Review of Autonomous Path Planning Algorithms for Mobile Robots. Drones 2023, 7, 211. [Google Scholar] [CrossRef]
- LaValle, S.M. Rapidly-Exploring Random Trees: A New Tool for Path Planning. In Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Leuven, Belgium, 16–21 May 1998; pp. 1–6. [Google Scholar]
- Karaman, S.; Frazzoli, E. Sampling-Based Algorithms for Optimal Motion Planning. arXiv 2011, arXiv:1105.1186. [Google Scholar] [CrossRef]
- Khatib, O. Real-time obstacle avoidance for manipulators and mobile robots. Int. J. Robot. Res. 1986, 5, 90–98. [Google Scholar] [CrossRef]
- Borenstein, J.; Heragu, S.; Koren, Y. The vector field histogram for real-time obstacle avoidance. IEEE Trans. Robot. Autom. 1991, 7, 487–495. [Google Scholar] [CrossRef]
- Tahir, Z.; Qureshi, A.; Ayaz, Y.; Nawaz, R. Potentially Guided Bidirectionalized RRT* for Fast Optimal Path Planning in Cluttered Environments. Robot. Auton. Syst. 2018, 108, 13–27. [Google Scholar] [CrossRef]
- Wu, D.; Wei, L.; Wang, G.; Tian, L.; Dai, G. APF-IRRT*: An Improved Informed Rapidly-Exploring Random Trees-Star Algorithm by Introducing Artificial Potential Field Method for Mobile Robot Path Planning. Appl. Sci. 2022, 12, 10905. [Google Scholar] [CrossRef]
- Wang, L.; Yang, X.; Chen, Z.; Wang, B. Application of the Improved Rapidly Exploring Random Tree Algorithm to an Insect-like Mobile Robot in a Narrow Environment. Biomimetics 2023, 8, 374. [Google Scholar] [CrossRef] [PubMed]
- Ma, B.; Ji, Y.; Fang, L. A Multi-UAV Formation Obstacle Avoidance Method Combined Improved Simulated Annealing and Adaptive Artificial Potential Field. arXiv 2025, arXiv:2504.11064. [Google Scholar] [CrossRef]
- Rezeck, P.; Azpurua, H.; Correa, M.F.; Chaimowicz, L. HeRo 2.0: A Low-Cost Robot for Swarm Robotics Research. arXiv 2022, arXiv:2202.12391. [Google Scholar] [CrossRef]
- Arvin, F.; Samsudin, K.; Ramli, A. Development of IR-Based Short-Range Communication Techniques for Swarm Robot Applications. Adv. Electr. Comput. Eng. 2010, 10, 61–68. [Google Scholar] [CrossRef]
- Correll, N.; Cianci, C.; Raemy, X.; Martinoli, A. Self-Organized Embedded Sensor/Actuator Networks for “Smart” Turbines. In Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems Workshop on Network Robot System: Toward Intelligent Robotic Systems Integrated with Environments, Beijing, China, 10 October 2006. [Google Scholar]
- Shih, C.L.; Lin, L.C. Trajectory Planning and Tracking Control of a Differential-Drive Mobile Robot in a Picture Drawing Application. Robotics 2017, 6, 17. [Google Scholar] [CrossRef]
- Rubies, E.; Palacín, J. Design and FDM/FFF Implementation of a Compact Omnidirectional Wheel for a Mobile Robot and Assessment of ABS and PLA Printing Materials. Robotics 2020, 9, 43. [Google Scholar] [CrossRef]
- Neto, B.S.R.; Araújo, T.D.O.; Meiguins, B.S.; Santos, C.G.R. Tape-Shaped, Multiscale, and Continuous-Readable Fiducial Marker for Indoor Navigation and Localization Systems. Sensors 2024, 24, 4605. [Google Scholar] [CrossRef]
Experimental Robot Specifications | ||
---|---|---|
Parameter | Value | Details |
Dimensions | mm | Length × Width × Height of AGV system |
Weight | 450 g | Weight of the assembled robotic system with effector |
Motors | DC Motor N20 | Motor with 75:1 gear ratio, 400 RPM and torque of |
Battery | Redox LiPo | Battery with nominal 11.1 V with 3S cells and 900 mAh capacity |
Battery Life | 50 min | Measured value gives a time that is scalable and fully operating |
Positioning System | ArUco | 50 × 50 mm markers with a 4 × 4 binary matrix |
Communication System | Wi-Fi | Usage of UDP to minimize time between packets |
MCU | Wio RP2040 | Dual-core Cortex M0+ Processor with integrated ESP8285 |
Max. Payload | 200 g | Weight of maximum payload robot can both lift and transport |
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content. |
© 2025 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (https://creativecommons.org/licenses/by/4.0/).
Share and Cite
Lajčiak, M.; Vachálek, J. Swarm Control with RRT-APF Planning and FNN Task Allocation Tested on Mobile Differential Platform. Sensors 2025, 25, 3886. https://doi.org/10.3390/s25133886
Lajčiak M, Vachálek J. Swarm Control with RRT-APF Planning and FNN Task Allocation Tested on Mobile Differential Platform. Sensors. 2025; 25(13):3886. https://doi.org/10.3390/s25133886
Chicago/Turabian StyleLajčiak, Michal, and Ján Vachálek. 2025. "Swarm Control with RRT-APF Planning and FNN Task Allocation Tested on Mobile Differential Platform" Sensors 25, no. 13: 3886. https://doi.org/10.3390/s25133886
APA StyleLajčiak, M., & Vachálek, J. (2025). Swarm Control with RRT-APF Planning and FNN Task Allocation Tested on Mobile Differential Platform. Sensors, 25(13), 3886. https://doi.org/10.3390/s25133886