Implemented collision detection and move
Algorithm is wrong
Sample solve run