Merge tag 'trace-v5.11' of git://git.kernel.org/pub/scm/linux/kernel/git/rostedt...

[linux-2.6-microblaze.git] / drivers / mfd / da9062-core.c

diff --git a/drivers/mfd/da9062-core.c b/drivers/mfd/da9062-core.c
index 419c735..8d91337 100644 (file)
--- a/drivers/mfd/da9062-core.c
+++ b/drivers/mfd/da9062-core.c
@@ -21,6 +21,9 @@
 #define        DA9062_REG_EVENT_B_OFFSET       1
 #define        DA9062_REG_EVENT_C_OFFSET       2
 
+#define        DA9062_IRQ_LOW  0
+#define        DA9062_IRQ_HIGH 1
+
 static struct regmap_irq da9061_irqs[] = {
        /* EVENT A */
        [DA9061_IRQ_ONKEY] = {
@@ -157,23 +160,23 @@ static struct regmap_irq_chip da9062_irq_chip = {
        .ack_base = DA9062AA_EVENT_A,
 };
 
-static struct resource da9061_core_resources[] = {
+static const struct resource da9061_core_resources[] = {
        DEFINE_RES_IRQ_NAMED(DA9061_IRQ_VDD_WARN, "VDD_WARN"),
 };
 
-static struct resource da9061_regulators_resources[] = {
+static const struct resource da9061_regulators_resources[] = {
        DEFINE_RES_IRQ_NAMED(DA9061_IRQ_LDO_LIM, "LDO_LIM"),
 };
 
-static struct resource da9061_thermal_resources[] = {
+static const struct resource da9061_thermal_resources[] = {
        DEFINE_RES_IRQ_NAMED(DA9061_IRQ_TEMP, "THERMAL"),
 };
 
-static struct resource da9061_wdt_resources[] = {
+static const struct resource da9061_wdt_resources[] = {
        DEFINE_RES_IRQ_NAMED(DA9061_IRQ_WDG_WARN, "WD_WARN"),
 };
 
-static struct resource da9061_onkey_resources[] = {
+static const struct resource da9061_onkey_resources[] = {
        DEFINE_RES_IRQ_NAMED(DA9061_IRQ_ONKEY, "ONKEY"),
 };
 
@@ -208,32 +211,32 @@ static const struct mfd_cell da9061_devs[] = {
        },
 };
 
-static struct resource da9062_core_resources[] = {
+static const struct resource da9062_core_resources[] = {
        DEFINE_RES_NAMED(DA9062_IRQ_VDD_WARN, 1, "VDD_WARN", IORESOURCE_IRQ),
 };
 
-static struct resource da9062_regulators_resources[] = {
+static const struct resource da9062_regulators_resources[] = {
        DEFINE_RES_NAMED(DA9062_IRQ_LDO_LIM, 1, "LDO_LIM", IORESOURCE_IRQ),
 };
 
-static struct resource da9062_thermal_resources[] = {
+static const struct resource da9062_thermal_resources[] = {
        DEFINE_RES_NAMED(DA9062_IRQ_TEMP, 1, "THERMAL", IORESOURCE_IRQ),
 };
 
-static struct resource da9062_wdt_resources[] = {
+static const struct resource da9062_wdt_resources[] = {
        DEFINE_RES_NAMED(DA9062_IRQ_WDG_WARN, 1, "WD_WARN", IORESOURCE_IRQ),
 };
 
-static struct resource da9062_rtc_resources[] = {
+static const struct resource da9062_rtc_resources[] = {
        DEFINE_RES_NAMED(DA9062_IRQ_ALARM, 1, "ALARM", IORESOURCE_IRQ),
        DEFINE_RES_NAMED(DA9062_IRQ_TICK, 1, "TICK", IORESOURCE_IRQ),
 };
 
-static struct resource da9062_onkey_resources[] = {
+static const struct resource da9062_onkey_resources[] = {
        DEFINE_RES_NAMED(DA9062_IRQ_ONKEY, 1, "ONKEY", IORESOURCE_IRQ),
 };
 
-static struct resource da9062_gpio_resources[] = {
+static const struct resource da9062_gpio_resources[] = {
        DEFINE_RES_NAMED(DA9062_IRQ_GPI0, 1, "GPI0", IORESOURCE_IRQ),
        DEFINE_RES_NAMED(DA9062_IRQ_GPI1, 1, "GPI1", IORESOURCE_IRQ),
        DEFINE_RES_NAMED(DA9062_IRQ_GPI2, 1, "GPI2", IORESOURCE_IRQ),
@@ -369,6 +372,33 @@ static int da9062_get_device_type(struct da9062 *chip)
        return ret;
 }
 
+static u32 da9062_configure_irq_type(struct da9062 *chip, int irq, u32 *trigger)
+{
+       u32 irq_type = 0;
+       struct irq_data *irq_data = irq_get_irq_data(irq);
+
+       if (!irq_data) {
+               dev_err(chip->dev, "Invalid IRQ: %d\n", irq);
+               return -EINVAL;
+       }
+       *trigger = irqd_get_trigger_type(irq_data);
+
+       switch (*trigger) {
+       case IRQ_TYPE_LEVEL_HIGH:
+               irq_type = DA9062_IRQ_HIGH;
+               break;
+       case IRQ_TYPE_LEVEL_LOW:
+               irq_type = DA9062_IRQ_LOW;
+               break;
+       default:
+               dev_warn(chip->dev, "Unsupported IRQ type: %d\n", *trigger);
+               return -EINVAL;
+       }
+       return regmap_update_bits(chip->regmap, DA9062AA_CONFIG_A,
+                       DA9062AA_IRQ_TYPE_MASK,
+                       irq_type << DA9062AA_IRQ_TYPE_SHIFT);
+}
+
 static const struct regmap_range da9061_aa_readable_ranges[] = {
        regmap_reg_range(DA9062AA_PAGE_CON, DA9062AA_STATUS_B),
        regmap_reg_range(DA9062AA_STATUS_D, DA9062AA_EVENT_C),
@@ -388,6 +418,7 @@ static const struct regmap_range da9061_aa_readable_ranges[] = {
        regmap_reg_range(DA9062AA_VBUCK1_A, DA9062AA_VBUCK4_A),
        regmap_reg_range(DA9062AA_VBUCK3_A, DA9062AA_VBUCK3_A),
        regmap_reg_range(DA9062AA_VLDO1_A, DA9062AA_VLDO4_A),
+       regmap_reg_range(DA9062AA_CONFIG_A, DA9062AA_CONFIG_A),
        regmap_reg_range(DA9062AA_VBUCK1_B, DA9062AA_VBUCK4_B),
        regmap_reg_range(DA9062AA_VBUCK3_B, DA9062AA_VBUCK3_B),
        regmap_reg_range(DA9062AA_VLDO1_B, DA9062AA_VLDO4_B),
@@ -417,6 +448,7 @@ static const struct regmap_range da9061_aa_writeable_ranges[] = {
        regmap_reg_range(DA9062AA_VBUCK1_A, DA9062AA_VBUCK4_A),
        regmap_reg_range(DA9062AA_VBUCK3_A, DA9062AA_VBUCK3_A),
        regmap_reg_range(DA9062AA_VLDO1_A, DA9062AA_VLDO4_A),
+       regmap_reg_range(DA9062AA_CONFIG_A, DA9062AA_CONFIG_A),
        regmap_reg_range(DA9062AA_VBUCK1_B, DA9062AA_VBUCK4_B),
        regmap_reg_range(DA9062AA_VBUCK3_B, DA9062AA_VBUCK3_B),
        regmap_reg_range(DA9062AA_VLDO1_B, DA9062AA_VLDO4_B),
@@ -596,6 +628,7 @@ static int da9062_i2c_probe(struct i2c_client *i2c,
        const struct regmap_irq_chip *irq_chip;
        const struct regmap_config *config;
        int cell_num;
+       u32 trigger_type = 0;
        int ret;
 
        chip = devm_kzalloc(&i2c->dev, sizeof(*chip), GFP_KERNEL);
@@ -654,10 +687,15 @@ static int da9062_i2c_probe(struct i2c_client *i2c,
        if (ret)
                return ret;
 
+       ret = da9062_configure_irq_type(chip, i2c->irq, &trigger_type);
+       if (ret < 0) {
+               dev_err(chip->dev, "Failed to configure IRQ type\n");
+               return ret;
+       }
+
        ret = regmap_add_irq_chip(chip->regmap, i2c->irq,
-                       IRQF_TRIGGER_LOW | IRQF_ONESHOT | IRQF_SHARED,
-                       -1, irq_chip,
-                       &chip->regmap_irq);
+                       trigger_type | IRQF_SHARED | IRQF_ONESHOT,
+                       -1, irq_chip, &chip->regmap_irq);
        if (ret) {
                dev_err(chip->dev, "Failed to request IRQ %d: %d\n",
                        i2c->irq, ret);
@@ -698,7 +736,7 @@ MODULE_DEVICE_TABLE(i2c, da9062_i2c_id);
 static struct i2c_driver da9062_i2c_driver = {
        .driver = {
                .name = "da9062",
-               .of_match_table = of_match_ptr(da9062_dt_ids),
+               .of_match_table = da9062_dt_ids,
        },
        .probe    = da9062_i2c_probe,
        .remove   = da9062_i2c_remove,