Added collision test into test program.