#5 Added test/demo for collision optimization