pinctrl: Remove duplicate code in pinctrl_pm_select_state functions