Commit 0b73ee5d authored by Laurent Pinchart's avatar Laurent Pinchart

sh-pfc: Simplify the sh_pfc_gpio_is_pin() logic

The function is guaranteed to be called with a gpio number smaller than
nr_pins. The condition can the be simplified, and the function inlined.
Signed-off-by: default avatarLaurent Pinchart <laurent.pinchart+renesas@ideasonboard.com>
Acked-by: default avatarLinus Walleij <linus.walleij@linaro.org>
parent a68fdca9
...@@ -89,12 +89,6 @@ static int sh_pfc_enum_in_range(pinmux_enum_t enum_id, struct pinmux_range *r) ...@@ -89,12 +89,6 @@ static int sh_pfc_enum_in_range(pinmux_enum_t enum_id, struct pinmux_range *r)
return 1; return 1;
} }
static bool sh_pfc_gpio_is_pin(struct sh_pfc *pfc, unsigned int gpio)
{
return (gpio < pfc->info->nr_pins) &&
(pfc->info->pins[gpio].enum_id != 0);
}
static unsigned long sh_pfc_read_raw_reg(void __iomem *mapped_reg, static unsigned long sh_pfc_read_raw_reg(void __iomem *mapped_reg,
unsigned long reg_width) unsigned long reg_width)
{ {
...@@ -226,15 +220,12 @@ static void sh_pfc_write_config_reg(struct sh_pfc *pfc, ...@@ -226,15 +220,12 @@ static void sh_pfc_write_config_reg(struct sh_pfc *pfc,
sh_pfc_write_raw_reg(mapped_reg, crp->reg_width, data); sh_pfc_write_raw_reg(mapped_reg, crp->reg_width, data);
} }
static int sh_pfc_setup_data_reg(struct sh_pfc *pfc, unsigned gpio) static void sh_pfc_setup_data_reg(struct sh_pfc *pfc, unsigned gpio)
{ {
struct sh_pfc_pin *gpiop = &pfc->info->pins[gpio]; struct sh_pfc_pin *gpiop = &pfc->info->pins[gpio];
struct pinmux_data_reg *data_reg; struct pinmux_data_reg *data_reg;
int k, n; int k, n;
if (!sh_pfc_gpio_is_pin(pfc, gpio))
return -1;
k = 0; k = 0;
while (1) { while (1) {
data_reg = pfc->info->data_regs + k; data_reg = pfc->info->data_regs + k;
...@@ -250,15 +241,13 @@ static int sh_pfc_setup_data_reg(struct sh_pfc *pfc, unsigned gpio) ...@@ -250,15 +241,13 @@ static int sh_pfc_setup_data_reg(struct sh_pfc *pfc, unsigned gpio)
gpiop->flags |= (k << PINMUX_FLAG_DREG_SHIFT); gpiop->flags |= (k << PINMUX_FLAG_DREG_SHIFT);
gpiop->flags &= ~PINMUX_FLAG_DBIT; gpiop->flags &= ~PINMUX_FLAG_DBIT;
gpiop->flags |= (n << PINMUX_FLAG_DBIT_SHIFT); gpiop->flags |= (n << PINMUX_FLAG_DBIT_SHIFT);
return 0; return;
} }
} }
k++; k++;
} }
BUG(); BUG();
return -1;
} }
static void sh_pfc_setup_data_regs(struct sh_pfc *pfc) static void sh_pfc_setup_data_regs(struct sh_pfc *pfc)
...@@ -266,8 +255,12 @@ static void sh_pfc_setup_data_regs(struct sh_pfc *pfc) ...@@ -266,8 +255,12 @@ static void sh_pfc_setup_data_regs(struct sh_pfc *pfc)
struct pinmux_data_reg *drp; struct pinmux_data_reg *drp;
int k; int k;
for (k = 0; k < pfc->info->nr_pins; k++) for (k = 0; k < pfc->info->nr_pins; k++) {
if (pfc->info->pins[k].enum_id == 0)
continue;
sh_pfc_setup_data_reg(pfc, k); sh_pfc_setup_data_reg(pfc, k);
}
k = 0; k = 0;
while (1) { while (1) {
...@@ -282,20 +275,16 @@ static void sh_pfc_setup_data_regs(struct sh_pfc *pfc) ...@@ -282,20 +275,16 @@ static void sh_pfc_setup_data_regs(struct sh_pfc *pfc)
} }
} }
int sh_pfc_get_data_reg(struct sh_pfc *pfc, unsigned gpio, void sh_pfc_get_data_reg(struct sh_pfc *pfc, unsigned gpio,
struct pinmux_data_reg **drp, int *bitp) struct pinmux_data_reg **drp, int *bitp)
{ {
struct sh_pfc_pin *gpiop = &pfc->info->pins[gpio]; struct sh_pfc_pin *gpiop = &pfc->info->pins[gpio];
int k, n; int k, n;
if (!sh_pfc_gpio_is_pin(pfc, gpio))
return -1;
k = (gpiop->flags & PINMUX_FLAG_DREG) >> PINMUX_FLAG_DREG_SHIFT; k = (gpiop->flags & PINMUX_FLAG_DREG) >> PINMUX_FLAG_DREG_SHIFT;
n = (gpiop->flags & PINMUX_FLAG_DBIT) >> PINMUX_FLAG_DBIT_SHIFT; n = (gpiop->flags & PINMUX_FLAG_DBIT) >> PINMUX_FLAG_DBIT_SHIFT;
*drp = pfc->info->data_regs + k; *drp = pfc->info->data_regs + k;
*bitp = n; *bitp = n;
return 0;
} }
static int sh_pfc_get_config_reg(struct sh_pfc *pfc, pinmux_enum_t enum_id, static int sh_pfc_get_config_reg(struct sh_pfc *pfc, pinmux_enum_t enum_id,
......
...@@ -47,8 +47,8 @@ int sh_pfc_unregister_pinctrl(struct sh_pfc *pfc); ...@@ -47,8 +47,8 @@ int sh_pfc_unregister_pinctrl(struct sh_pfc *pfc);
int sh_pfc_read_bit(struct pinmux_data_reg *dr, unsigned long in_pos); int sh_pfc_read_bit(struct pinmux_data_reg *dr, unsigned long in_pos);
void sh_pfc_write_bit(struct pinmux_data_reg *dr, unsigned long in_pos, void sh_pfc_write_bit(struct pinmux_data_reg *dr, unsigned long in_pos,
unsigned long value); unsigned long value);
int sh_pfc_get_data_reg(struct sh_pfc *pfc, unsigned gpio, void sh_pfc_get_data_reg(struct sh_pfc *pfc, unsigned gpio,
struct pinmux_data_reg **drp, int *bitp); struct pinmux_data_reg **drp, int *bitp);
int sh_pfc_config_mux(struct sh_pfc *pfc, unsigned mark, int pinmux_type, int sh_pfc_config_mux(struct sh_pfc *pfc, unsigned mark, int pinmux_type,
int cfg_mode); int cfg_mode);
......
...@@ -42,6 +42,11 @@ static struct sh_pfc *gpio_to_pfc(struct gpio_chip *gc) ...@@ -42,6 +42,11 @@ static struct sh_pfc *gpio_to_pfc(struct gpio_chip *gc)
static int gpio_pin_request(struct gpio_chip *gc, unsigned offset) static int gpio_pin_request(struct gpio_chip *gc, unsigned offset)
{ {
struct sh_pfc *pfc = gpio_to_pfc(gc);
if (pfc->info->pins[offset].enum_id == 0)
return -EINVAL;
return pinctrl_request_gpio(offset); return pinctrl_request_gpio(offset);
} }
...@@ -52,12 +57,10 @@ static void gpio_pin_free(struct gpio_chip *gc, unsigned offset) ...@@ -52,12 +57,10 @@ static void gpio_pin_free(struct gpio_chip *gc, unsigned offset)
static void gpio_pin_set_value(struct sh_pfc *pfc, unsigned offset, int value) static void gpio_pin_set_value(struct sh_pfc *pfc, unsigned offset, int value)
{ {
struct pinmux_data_reg *dr = NULL; struct pinmux_data_reg *dr;
int bit = 0; int bit;
if (sh_pfc_get_data_reg(pfc, offset, &dr, &bit) != 0)
BUG();
sh_pfc_get_data_reg(pfc, offset, &dr, &bit);
sh_pfc_write_bit(dr, bit, value); sh_pfc_write_bit(dr, bit, value);
} }
...@@ -77,12 +80,10 @@ static int gpio_pin_direction_output(struct gpio_chip *gc, unsigned offset, ...@@ -77,12 +80,10 @@ static int gpio_pin_direction_output(struct gpio_chip *gc, unsigned offset,
static int gpio_pin_get(struct gpio_chip *gc, unsigned offset) static int gpio_pin_get(struct gpio_chip *gc, unsigned offset)
{ {
struct sh_pfc *pfc = gpio_to_pfc(gc); struct sh_pfc *pfc = gpio_to_pfc(gc);
struct pinmux_data_reg *dr = NULL; struct pinmux_data_reg *dr;
int bit = 0; int bit;
if (sh_pfc_get_data_reg(pfc, offset, &dr, &bit) != 0)
return -EINVAL;
sh_pfc_get_data_reg(pfc, offset, &dr, &bit);
return sh_pfc_read_bit(dr, bit); return sh_pfc_read_bit(dr, bit);
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment