Move visual servo params into one config file
Reference visual servo params in config
Get servo params from config yaml file
Removed servo fail announcement, redundant