Stripped down robot arm code to essentials