Let's Make Robots!

Help with 18x Electric Vehicle code

I'm working on some code for an event in Science Olmpiad in New york, the code below should check input 2 for a high signal, then jump to sub Diselect, then check for the pins for the right combonations of inputs to then jump to the assosiated sub, the subs take a plse input from an optointerupt and record the length of the pulse to w0, it wil pulse the servo until w0 is equal to the assigned number.