mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2025-01-23 23:59:38 +07:00
pinctrl: sh-pfc: refactor voltage setting
All known hardware being able to switch voltages has the same POCCTRL register. So, factor out the common code to the core and keep only the pin-to-bit mapping SoC specific. Convert the only user, r8a7790. In case POCCTRL should ever get more complex (more voltages to select?), we should probably switch over to a describing array like drive strength does currently. Signed-off-by: Wolfram Sang <wsa+renesas@sang-engineering.com> Signed-off-by: Geert Uytterhoeven <geert+renesas@glider.be>
This commit is contained in:
parent
1a695a905c
commit
8775306dcf
@ -4696,47 +4696,6 @@ static const char * const vin3_groups[] = {
|
||||
"vin3_clk",
|
||||
};
|
||||
|
||||
#define IOCTRL6 0x8c
|
||||
|
||||
static int r8a7790_get_io_voltage(struct sh_pfc *pfc, unsigned int pin)
|
||||
{
|
||||
u32 data, mask;
|
||||
|
||||
if (WARN(pin < RCAR_GP_PIN(3, 0) || pin > RCAR_GP_PIN(3, 31), "invalid pin %#x", pin))
|
||||
return -EINVAL;
|
||||
|
||||
data = ioread32(pfc->windows->virt + IOCTRL6),
|
||||
/* Bits in IOCTRL6 are numbered in opposite order to pins */
|
||||
mask = 0x80000000 >> (pin & 0x1f);
|
||||
|
||||
return (data & mask) ? 3300 : 1800;
|
||||
}
|
||||
|
||||
static int r8a7790_set_io_voltage(struct sh_pfc *pfc, unsigned int pin, u16 mV)
|
||||
{
|
||||
u32 data, mask;
|
||||
|
||||
if (WARN(pin < RCAR_GP_PIN(3, 0) || pin > RCAR_GP_PIN(3, 31), "invalid pin %#x", pin))
|
||||
return -EINVAL;
|
||||
|
||||
if (mV != 1800 && mV != 3300)
|
||||
return -EINVAL;
|
||||
|
||||
data = ioread32(pfc->windows->virt + IOCTRL6);
|
||||
/* Bits in IOCTRL6 are numbered in opposite order to pins */
|
||||
mask = 0x80000000 >> (pin & 0x1f);
|
||||
|
||||
if (mV == 3300)
|
||||
data |= mask;
|
||||
else
|
||||
data &= ~mask;
|
||||
|
||||
iowrite32(~data, pfc->windows->virt); /* unlock reg */
|
||||
iowrite32(data, pfc->windows->virt + IOCTRL6);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct sh_pfc_function pinmux_functions[] = {
|
||||
SH_PFC_FUNCTION(audio_clk),
|
||||
SH_PFC_FUNCTION(avb),
|
||||
@ -5736,14 +5695,23 @@ static const struct pinmux_cfg_reg pinmux_config_regs[] = {
|
||||
{ },
|
||||
};
|
||||
|
||||
static const struct sh_pfc_soc_operations pinmux_ops = {
|
||||
.get_io_voltage = r8a7790_get_io_voltage,
|
||||
.set_io_voltage = r8a7790_set_io_voltage,
|
||||
static int r8a7790_pin_to_pocctrl(struct sh_pfc *pfc, unsigned int pin, u32 *pocctrl)
|
||||
{
|
||||
if (pin < RCAR_GP_PIN(3, 0) || pin > RCAR_GP_PIN(3, 31))
|
||||
return -EINVAL;
|
||||
|
||||
*pocctrl = 0xe606008c;
|
||||
|
||||
return 31 - (pin & 0x1f);
|
||||
}
|
||||
|
||||
static const struct sh_pfc_soc_operations r8a7790_pinmux_ops = {
|
||||
.pin_to_pocctrl = r8a7790_pin_to_pocctrl,
|
||||
};
|
||||
|
||||
const struct sh_pfc_soc_info r8a7790_pinmux_info = {
|
||||
.name = "r8a77900_pfc",
|
||||
.ops = &pinmux_ops,
|
||||
.ops = &r8a7790_pinmux_ops,
|
||||
.unlock_reg = 0xe6060000, /* PMMR */
|
||||
|
||||
.function = { PINMUX_FUNCTION_BEGIN, PINMUX_FUNCTION_END },
|
||||
|
@ -632,19 +632,21 @@ static int sh_pfc_pinconf_get(struct pinctrl_dev *pctldev, unsigned _pin,
|
||||
}
|
||||
|
||||
case PIN_CONFIG_POWER_SOURCE: {
|
||||
int ret;
|
||||
u32 pocctrl, val;
|
||||
int bit;
|
||||
|
||||
if (!pfc->info->ops || !pfc->info->ops->get_io_voltage)
|
||||
if (!pfc->info->ops || !pfc->info->ops->pin_to_pocctrl)
|
||||
return -ENOTSUPP;
|
||||
|
||||
bit = pfc->info->ops->pin_to_pocctrl(pfc, _pin, &pocctrl);
|
||||
if (WARN(bit < 0, "invalid pin %#x", _pin))
|
||||
return bit;
|
||||
|
||||
spin_lock_irqsave(&pfc->lock, flags);
|
||||
ret = pfc->info->ops->get_io_voltage(pfc, _pin);
|
||||
val = sh_pfc_read_reg(pfc, pocctrl, 32);
|
||||
spin_unlock_irqrestore(&pfc->lock, flags);
|
||||
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
*config = ret;
|
||||
*config = (val & BIT(bit)) ? 3300 : 1800;
|
||||
break;
|
||||
}
|
||||
|
||||
@ -696,19 +698,28 @@ static int sh_pfc_pinconf_set(struct pinctrl_dev *pctldev, unsigned _pin,
|
||||
}
|
||||
|
||||
case PIN_CONFIG_POWER_SOURCE: {
|
||||
unsigned int arg =
|
||||
pinconf_to_config_argument(configs[i]);
|
||||
int ret;
|
||||
unsigned int mV = pinconf_to_config_argument(configs[i]);
|
||||
u32 pocctrl, val;
|
||||
int bit;
|
||||
|
||||
if (!pfc->info->ops || !pfc->info->ops->set_io_voltage)
|
||||
if (!pfc->info->ops || !pfc->info->ops->pin_to_pocctrl)
|
||||
return -ENOTSUPP;
|
||||
|
||||
spin_lock_irqsave(&pfc->lock, flags);
|
||||
ret = pfc->info->ops->set_io_voltage(pfc, _pin, arg);
|
||||
spin_unlock_irqrestore(&pfc->lock, flags);
|
||||
bit = pfc->info->ops->pin_to_pocctrl(pfc, _pin, &pocctrl);
|
||||
if (WARN(bit < 0, "invalid pin %#x", _pin))
|
||||
return bit;
|
||||
|
||||
if (ret)
|
||||
return ret;
|
||||
if (mV != 1800 && mV != 3300)
|
||||
return -EINVAL;
|
||||
|
||||
spin_lock_irqsave(&pfc->lock, flags);
|
||||
val = sh_pfc_read_reg(pfc, pocctrl, 32);
|
||||
if (mV == 3300)
|
||||
val |= BIT(bit);
|
||||
else
|
||||
val &= ~BIT(bit);
|
||||
sh_pfc_write_reg(pfc, pocctrl, 32, val);
|
||||
spin_unlock_irqrestore(&pfc->lock, flags);
|
||||
|
||||
break;
|
||||
}
|
||||
|
@ -189,9 +189,7 @@ struct sh_pfc_soc_operations {
|
||||
unsigned int (*get_bias)(struct sh_pfc *pfc, unsigned int pin);
|
||||
void (*set_bias)(struct sh_pfc *pfc, unsigned int pin,
|
||||
unsigned int bias);
|
||||
int (*get_io_voltage)(struct sh_pfc *pfc, unsigned int pin);
|
||||
int (*set_io_voltage)(struct sh_pfc *pfc, unsigned int pin,
|
||||
u16 voltage_mV);
|
||||
int (*pin_to_pocctrl)(struct sh_pfc *pfc, unsigned int pin, u32 *pocctrl);
|
||||
};
|
||||
|
||||
struct sh_pfc_soc_info {
|
||||
|
Loading…
Reference in New Issue
Block a user