private void CloseConnection()
    {
        if (servo != null)
        {
            servo.Close();
            servo = null;
        }

        if (sensorDistance != null)
        {
            sensorDistance.Close();
            sensorDistance = null;
        }
    }
        public void OnMainWindowClosing(object sender, CancelEventArgs e)
        {
            Debug.WriteLine("Closing");

            if (servo != null)
            {
                try
                {
                    if (servo.Attached)
                    {
                        servo.Engaged = false;
                        servo.Close();
                    }
                }
                catch (PhidgetException exp)
                {
                    Debug.WriteLine($"Got Phidget Exception {exp}");
                }
            }
        }