From cout to ODEBUG macro

Reinforce the 80 columns convention

Working version with Talos and dynamical filter.
Computation time needs to be checked.

Maximum speed reach with TALOS when setting SS phase to 1.0.
Divergence otherwise.

Current status: The sign of the orientation seems to be wrong.
TODO: Check where does this comes from.

and faster debugging.