exit with -1 when error (for travis)
prepare a boolean to show the collision
draw additionnal lines
fix redundant getndof
allow to visualize environment with several objects