Update motor configs. Create simple logic for elbow/shoulder joints.