HARDWARE: Add arm servo control: shoulder, elbow

See readme.md's