Reworked code to add UP / DOWN arm controls. P control of arm position. Move straight for distance