Tuned the turning controller and misc verbose fixes
Merge branch 'develop' of github.com:DD2425-group-5/controllers into develop