A few directions of future work this project could look at are:
Use a professional package to build a robust event-driven based collaboration system. State Machines can be implemented using YASMIN or SMACC2 in ROS2.
Implement Grasping Functionality for the blocks in simulation so that they stick to the gripper when being picked and placed
Create a robust and accurate based feedback control system to prevent overshoots and undershoots during Navigation
Perform more experiments and actions using the real Locobot