Working arduino program opens and closes arm