Updated controller to add turning for collision detection + debuging comments + main for testing
Currently not finished pushed only to save the progress. Can be ignored for now
Currently not finished pushed only to save the progress. Can be ignored for now