Updated swarmbot with the sonarcallback function.