@@ -19,24 +19,43 @@
#define TPS68470_N_LOGIC_OUTPUT 3
#define TPS68470_N_REGULAR_GPIO 7
-#define TPS68470_N_GPIO (TPS68470_N_LOGIC_OUTPUT + TPS68470_N_REGULAR_GPIO)
+#define TPS68470_N_ILEDS 2
+#define TPS68470_N_GPIO (TPS68470_N_LOGIC_OUTPUT + TPS68470_N_REGULAR_GPIO + TPS68470_N_ILEDS)
struct tps68470_gpio_data {
struct regmap *tps68470_regmap;
struct gpio_chip gc;
};
+static void tps68470_gpio_get_reg_and_mask(bool get, unsigned int offset,
+ unsigned int *reg, int *mask)
+{
+ if (offset < TPS68470_N_REGULAR_GPIO) {
+ if (get)
+ *reg = TPS68470_REG_GPDI;
+ else
+ *reg = TPS68470_REG_GPDO;
+ *mask = BIT(offset);
+ } else if (offset < (TPS68470_N_REGULAR_GPIO + TPS68470_N_LOGIC_OUTPUT)) {
+ *reg = TPS68470_REG_SGPO;
+ *mask = BIT(offset - TPS68470_N_REGULAR_GPIO);
+ } else {
+ *reg = TPS68470_REG_ILEDCTL;
+ if (offset == (TPS68470_N_REGULAR_GPIO + TPS68470_N_LOGIC_OUTPUT))
+ *mask = TPS68470_ILEDCTL_ENA;
+ else
+ *mask = TPS68470_ILEDCTL_ENB;
+ }
+}
+
static int tps68470_gpio_get(struct gpio_chip *gc, unsigned int offset)
{
struct tps68470_gpio_data *tps68470_gpio = gpiochip_get_data(gc);
struct regmap *regmap = tps68470_gpio->tps68470_regmap;
- unsigned int reg = TPS68470_REG_GPDI;
- int val, ret;
+ int val, mask, ret;
+ unsigned int reg;
- if (offset >= TPS68470_N_REGULAR_GPIO) {
- offset -= TPS68470_N_REGULAR_GPIO;
- reg = TPS68470_REG_SGPO;
- }
+ tps68470_gpio_get_reg_and_mask(true, offset, ®, &mask);
ret = regmap_read(regmap, reg, &val);
if (ret) {
@@ -44,7 +63,7 @@ static int tps68470_gpio_get(struct gpio_chip *gc, unsigned int offset)
TPS68470_REG_SGPO);
return ret;
}
- return !!(val & BIT(offset));
+ return !!(val & mask);
}
static int tps68470_gpio_get_direction(struct gpio_chip *gc,
@@ -75,14 +94,12 @@ static void tps68470_gpio_set(struct gpio_chip *gc, unsigned int offset,
{
struct tps68470_gpio_data *tps68470_gpio = gpiochip_get_data(gc);
struct regmap *regmap = tps68470_gpio->tps68470_regmap;
- unsigned int reg = TPS68470_REG_GPDO;
+ unsigned int reg;
+ int mask;
- if (offset >= TPS68470_N_REGULAR_GPIO) {
- reg = TPS68470_REG_SGPO;
- offset -= TPS68470_N_REGULAR_GPIO;
- }
+ tps68470_gpio_get_reg_and_mask(false, offset, ®, &mask);
- regmap_update_bits(regmap, reg, BIT(offset), value ? BIT(offset) : 0);
+ regmap_update_bits(regmap, reg, mask, value ? mask : 0);
}
static int tps68470_gpio_output(struct gpio_chip *gc, unsigned int offset,
@@ -120,6 +137,7 @@ static const char *tps68470_names[TPS68470_N_GPIO] = {
"gpio.0", "gpio.1", "gpio.2", "gpio.3",
"gpio.4", "gpio.5", "gpio.6",
"s_enable", "s_idle", "s_resetn",
+ "ileda", "iledb",
};
static int tps68470_gpio_probe(struct platform_device *pdev)
@@ -34,6 +34,7 @@
#define TPS68470_REG_SGPO 0x22
#define TPS68470_REG_GPDI 0x26
#define TPS68470_REG_GPDO 0x27
+#define TPS68470_REG_ILEDCTL 0x28
#define TPS68470_REG_VCMVAL 0x3C
#define TPS68470_REG_VAUX1VAL 0x3D
#define TPS68470_REG_VAUX2VAL 0x3E
@@ -94,4 +95,7 @@
#define TPS68470_GPIO_MODE_OUT_CMOS 2
#define TPS68470_GPIO_MODE_OUT_ODRAIN 3
+#define TPS68470_ILEDCTL_ENA BIT(2)
+#define TPS68470_ILEDCTL_ENB BIT(6)
+
#endif /* __LINUX_MFD_TPS68470_H */
The tps68470 has support for 2 indicator LED outputs called ileda and iledb, at support for these as GPIO pins 10 + 11. Signed-off-by: Hans de Goede <hdegoede@redhat.com> --- drivers/gpio/gpio-tps68470.c | 46 +++++++++++++++++++++++++----------- include/linux/mfd/tps68470.h | 4 ++++ 2 files changed, 36 insertions(+), 14 deletions(-)