Full robot now has working arm which listen to variables
Merge to master