Work on launch files

- corrected main launch file
Work on recognition:

- Send detected rectangles to the reasoner
- Some code fixes to speedup algorithms (const references instead of copy constructor)