C robot control

Its considered generally more readable and better practice to have one return at an end of a method