added robot arm code, incl simulation