1 // SPDX-License-Identifier: (GPL-2.0+ OR MIT)
3  * Second generation of pinmux driver for Amlogic Meson-AXG SoC.
14  * Meson-AXG SoC and later series, which use 4-width continuous
25 #include "pinctrl-meson.h"
26 #include "pinctrl-meson-axg-pmx.h"
30 			const struct meson_pmx_bank **bank)  in meson_axg_pmx_get_bank()  argument
33 	const struct meson_axg_pmx_data *pmx = pc->data->pmx_data;  in meson_axg_pmx_get_bank()
35 	for (i = 0; i < pmx->num_pmx_banks; i++)  in meson_axg_pmx_get_bank()
36 		if (pin >= pmx->pmx_banks[i].first &&  in meson_axg_pmx_get_bank()
37 				pin <= pmx->pmx_banks[i].last) {  in meson_axg_pmx_get_bank()
38 			*bank = &pmx->pmx_banks[i];  in meson_axg_pmx_get_bank()
42 	return -EINVAL;  in meson_axg_pmx_get_bank()
45 static int meson_pmx_calc_reg_and_offset(const struct meson_pmx_bank *bank,  in meson_pmx_calc_reg_and_offset()  argument
51 	shift = pin - bank->first;  in meson_pmx_calc_reg_and_offset()
53 	*reg = bank->reg + (bank->offset + (shift << 2)) / 32;  in meson_pmx_calc_reg_and_offset()
54 	*offset = (bank->offset + (shift << 2)) % 32;  in meson_pmx_calc_reg_and_offset()
62 	const struct meson_pmx_bank *bank;  in meson_axg_pmx_update_function()  local
67 	ret = meson_axg_pmx_get_bank(pc, pin, &bank);  in meson_axg_pmx_update_function()
71 	meson_pmx_calc_reg_and_offset(bank, pin, &reg, &offset);  in meson_axg_pmx_update_function()
73 	ret = regmap_update_bits(pc->reg_mux, reg << 2,  in meson_axg_pmx_update_function()
85 	const struct meson_pmx_func *func = &pc->data->funcs[func_num];  in meson_axg_pmx_set_mux()
86 	const struct meson_pmx_group *group = &pc->data->groups[group_num];  in meson_axg_pmx_set_mux()
88 		(struct meson_pmx_axg_data *)group->data;  in meson_axg_pmx_set_mux()
90 	dev_dbg(pc->dev, "enable function %s, group %s\n", func->name,  in meson_axg_pmx_set_mux()
91 		group->name);  in meson_axg_pmx_set_mux()
93 	for (i = 0; i < group->num_pins; i++) {  in meson_axg_pmx_set_mux()
94 		ret = meson_axg_pmx_update_function(pc, group->pins[i],  in meson_axg_pmx_set_mux()
95 			pmx_data->func);  in meson_axg_pmx_set_mux()