Work in progress, I'm finishing the exploration branch at this moment adding SLAM and Explore_lite to perform explorations.
Next steps:
- Autonomous exploration.
- Adapt BT to be able to stop and pick objects.
- Improve cost system of explore_lite.
- Start perception + manip.