Arduino sketch for our Robot Arm