Updated controller to add turning for collision detection + debuging comments + main for testing

Valeriia Ponomarenkorequested to merge
valeriia/updated-controller into main

Currently not finished pushed only to save the progress. Can be ignored for now

Merge request reports