Ping is mostly working except with obstacles, no obstacles and it works great. Changed time to 2 seconds between turns to better analyze the data outputs/