[Owen Makin]

Well it looks very messy to me, because it seems there are many unnecessary while loops with no values being plugged in. Try writing down what you want the robot to do for how long and set up a timed sequence that executes everything as time progress .