I changed the entire code from the Mini Quadruped to get rid of the delay function and added a button to stop the robot, some problems are still in the code, like it walks directly forward if there is no more obstacle detected (it should walk min. 90 degrees), the walking pattern could be better, still work in progress.