[PATCH 6.1 076/325] pinctrl-tegra: Restore SFSEL bit when freeing pins