robot arm program almost finished

robot arm program almost finished