Work on BB and Romeo functions:

- Fixes concerning cost functions
- Fixes for BB
- Add/fix Romeo constraints
- Add function to list current collisions