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.