Working

Fixed various issue with program, robot still stalls sometimes, robot
reverses before climbing the ramp
working

works from the opposite side of the arena