Fixed Servo Motor and several ID missmatches in config.yml