Add assert in continuous collision checking.

3 jobs for master in 33 minutes and 14 seconds
Name Stage Failure
failed
robotpkg-hpp-core-16.04-release Test
No job log
failed
robotpkg-hpp-core-18.04-release Test
No job log
failed
doc-coverage Test
No job log