Finished collision test and main