Fixed bug for initial configuration when changing control mode