Working version, successfully controlling robot arm