Added sonar code to avoid obstacle
Added logging sonar on the main log system