MobilePlan - Optimization-powered mobile manipulation task planning for agriculture pick-and-carry tasks

The proposed TestBed offers an integrated platform for validating multi-robot autonomous crop collection in realistic agricultural logistics scenarios. Its core technology focus is the coordination of heterogeneous mobile manipulators through an optimization-based global planner, where the Crop Collection Problem is formulated as a Flexible Multi-Depot Capacitated Vehicle Routing Pickup Problem (FMDCVRP-P). This approach enables robots to dynamically start and end at different depots, reducing unnecessary travel and minimizing overall mission makespan.

The TestBed combines Mixed-Integer Linear Programming (MILP) optimization with a full ROS2–ROS1 simulation and deployment pipeline, including Gazebo-based multi-robot environments, task scheduling, MoveIt-enabled manipulation, and autonomous navigation using AMCL and TEB planners integrated for the RBKAIROS+ Mobile Manipulator.

This TestBed is highly relevant to DeepTech and Industry 5.0, supporting scalable, intelligent, and human-centered automation for next-generation sustainable agriculture and autonomous logistics.

Name of Principal Investigator: Kosta Jovanović
Position / institutional role: Associate professor
Info Email: kostaj@etf.rs
ORCID persistent identifier (PID): 0000-0002-9029-4465
Name of Host Organization  University of Belgrade – School of Electrical Engineering (ETF) 
Department or Lab   Department of Signals and Systems, ETF Robotics lab 
Name of Building  Palace of Science 
Physical Address   Kralja Milana 11, 11000 Beograd, Serbia 
Website Links  https://robot.etf.bg.ac.rs 
Institutional contact name  Nikola Knezevic
Institutional contact email  knezevic@etf.rs
Non-academic stakeholders
Industrial Partners; Startups; Professional Associations; SMEs

Government Bodies; Community

Academic stakeholders
Undergraduate students; PhD students; MSc students; Researchers
Other types of stakeholders
agri-tech integrators, logistics operators, farm cooperatives
Application case: Short description:
Multi-Robot Crop Collection Route Optimization (PoC) validation of optimization-based task allocation and routing for fleets of mobile manipulators performing post-harvest crop bin pickup and delivery while minimizing makespan and respecting payload and depot constraints
Autonomous Navigation and Obstacle Avoidance in Unstructured Environments testing robust navigation of RB-KAIROS platforms using AMCL and TEB in agricultural or industrial spaces with sparse features and non-uniform obstacles
Mobile Manipulation Pick-and-Carry Experiments integration of manipulation planning with autonomous base positioning to perform crop-bin pickup, transport, and delivery missions in simulation and on the real platform
Educational Use in Robotics and Autonomous Systems Courses supports coursework and student projects in ROS, optimization, mobile manipulation, and Industry 5.0 automation

list of hardware components with their brief descriptions:

1. RB-KAIROS Mobile Manipulator Platform (Robotnik) – omnidirectional mobile base with integrated manipulation support, suited for autonomous navigation in industrial logistics and field robotics. Link: https://robotnik.eu/products/mobile-robots/rb-kairos-2/
2. Franka Emika Research 3 (FR3) collaborative manipulator – 7 DoF torque-controlled robotic arm, payload 3 kg, reach 855 mm, suitable for safe manipulation experiments. Link: https://franka.de/franka-research-3
3. Robotics workstation / compute server – multi-core CPU and GPU-enabled system for MILP optimization, ROS middleware, Gazebo simulation, and motion planning.

list of software components with their brief descriptions:

1. Ubuntu Linux 20.04/22.04 LTS – primary OS for ROS-based robotics development. Link: https://ubuntu.com/download
2. ROS1 Noetic and ROS2 Humble/Iron – middleware for robot control, navigation, manipulation, and multi-robot coordination. Link: https://www.ros.org/
3. MoveIt Motion Planning Framework – arm manipulation planning and execution. Link: https://moveit.ros.org/
4. ROS Navigation Stack with AMCL and TEB local planner – autonomous navigation, localization, and obstacle avoidance. Links: https://wiki.ros.org/navigation and https://wiki.ros.org/teb_local_planner
5. Gurobi Optimizer – MILP solver for the Flexible Multi-Depot Capacitated VRP Pickup formulation. Link: https://www.gurobi.com/
6. Continuous development platform for RB-KAIROS robot control and planning. Link: https://github.com/etfrobotics/rbkairos_etf_services