Added button read debouncing and servo control.