Fix solveStep validate collision in configuration

Previously, `solveOptimizationProblem()` sometimes returns configuration
list that has collision in at least one configuration. This was possibly
because the collision validation is not working properly. Fixed by using
the new collision validation provided by hpp::core.

Some refactoring is also done to make the return of the function a bit
clearer (instead of simple int, use enum).