public void SetConfig(ConfigObject config)
 {
     this.config = config.Clone();
     servos      = null;
     servos      = new List <UcServoMain>();
     gridPanel.Children.Clear();
     LoadImage();
     for (int i = 0; i < config.max_servo; i++)
     {
         AddServo(config.servos[i].X, config.servos[i].Y);
     }
     SetStatus();
 }