Solved some problems in ros service CheckCollision
Merge branch 'master' of ssh://ris.upc.es/gitroot/kautham
Updated demos
Merge branch 'master' of ssh://ris.upc.es:2222/gitroot/kautham
Merge branch 'master' of ssh://ris.upc.es/gitroot/kautham