Quelle  max8998-irq.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0+
//
// Interrupt controller support for MAX8998
//
// Copyright (C) 2010 Samsung Electronics Co.Ltd
// Author: Joonyoung Shim <jy0922.shim@samsung.com>

#include <linux/device.h>
#include <linux/interrupt.h>
#include <linux/irq.h>
#include <linux/irqdomain.h>
#include <linux/mfd/max8998-private.h>

struct max8998_irq_data {
 int reg;
 int mask;
};

static struct max8998_irq_data max8998_irqs[] = {
 [MAX8998_IRQ_DCINF] = {
  .reg = 1,
  .mask = MAX8998_IRQ_DCINF_MASK,
 },
 [MAX8998_IRQ_DCINR] = {
  .reg = 1,
  .mask = MAX8998_IRQ_DCINR_MASK,
 },
 [MAX8998_IRQ_JIGF] = {
  .reg = 1,
  .mask = MAX8998_IRQ_JIGF_MASK,
 },
 [MAX8998_IRQ_JIGR] = {
  .reg = 1,
  .mask = MAX8998_IRQ_JIGR_MASK,
 },
 [MAX8998_IRQ_PWRONF] = {
  .reg = 1,
  .mask = MAX8998_IRQ_PWRONF_MASK,
 },
 [MAX8998_IRQ_PWRONR] = {
  .reg = 1,
  .mask = MAX8998_IRQ_PWRONR_MASK,
 },
 [MAX8998_IRQ_WTSREVNT] = {
  .reg = 2,
  .mask = MAX8998_IRQ_WTSREVNT_MASK,
 },
 [MAX8998_IRQ_SMPLEVNT] = {
  .reg = 2,
  .mask = MAX8998_IRQ_SMPLEVNT_MASK,
 },
 [MAX8998_IRQ_ALARM1] = {
  .reg = 2,
  .mask = MAX8998_IRQ_ALARM1_MASK,
 },
 [MAX8998_IRQ_ALARM0] = {
  .reg = 2,
  .mask = MAX8998_IRQ_ALARM0_MASK,
 },
 [MAX8998_IRQ_ONKEY1S] = {
  .reg = 3,
  .mask = MAX8998_IRQ_ONKEY1S_MASK,
 },
 [MAX8998_IRQ_TOPOFFR] = {
  .reg = 3,
  .mask = MAX8998_IRQ_TOPOFFR_MASK,
 },
 [MAX8998_IRQ_DCINOVPR] = {
  .reg = 3,
  .mask = MAX8998_IRQ_DCINOVPR_MASK,
 },
 [MAX8998_IRQ_CHGRSTF] = {
  .reg = 3,
  .mask = MAX8998_IRQ_CHGRSTF_MASK,
 },
 [MAX8998_IRQ_DONER] = {
  .reg = 3,
  .mask = MAX8998_IRQ_DONER_MASK,
 },
 [MAX8998_IRQ_CHGFAULT] = {
  .reg = 3,
  .mask = MAX8998_IRQ_CHGFAULT_MASK,
 },
 [MAX8998_IRQ_LOBAT1] = {
  .reg = 4,
  .mask = MAX8998_IRQ_LOBAT1_MASK,
 },
 [MAX8998_IRQ_LOBAT2] = {
  .reg = 4,
  .mask = MAX8998_IRQ_LOBAT2_MASK,
 },
};

static inline struct max8998_irq_data *
irq_to_max8998_irq(struct max8998_dev *max8998, struct irq_data *data)
{
 return &max8998_irqs[data->hwirq];
}

static void max8998_irq_lock(struct irq_data *data)
{
 struct max8998_dev *max8998 = irq_data_get_irq_chip_data(data);

 mutex_lock(&max8998->irqlock);
}

static void max8998_irq_sync_unlock(struct irq_data *data)
{
 struct max8998_dev *max8998 = irq_data_get_irq_chip_data(data);
 int i;

 for (i = 0; i < ARRAY_SIZE(max8998->irq_masks_cur); i++) {
  /*
 * If there's been a change in the mask write it back
 * to the hardware.
 */
  if (max8998->irq_masks_cur[i] != max8998->irq_masks_cache[i]) {
   max8998->irq_masks_cache[i] = max8998->irq_masks_cur[i];
   max8998_write_reg(max8998->i2c, MAX8998_REG_IRQM1 + i,
     max8998->irq_masks_cur[i]);
  }
 }

 mutex_unlock(&max8998->irqlock);
}

static void max8998_irq_unmask(struct irq_data *data)
{
 struct max8998_dev *max8998 = irq_data_get_irq_chip_data(data);
 struct max8998_irq_data *irq_data = irq_to_max8998_irq(max8998, data);

 max8998->irq_masks_cur[irq_data->reg - 1] &= ~irq_data->mask;
}

static void max8998_irq_mask(struct irq_data *data)
{
 struct max8998_dev *max8998 = irq_data_get_irq_chip_data(data);
 struct max8998_irq_data *irq_data = irq_to_max8998_irq(max8998, data);

 max8998->irq_masks_cur[irq_data->reg - 1] |= irq_data->mask;
}

static struct irq_chip max8998_irq_chip = {
 .name = "max8998",
 .irq_bus_lock = max8998_irq_lock,
 .irq_bus_sync_unlock = max8998_irq_sync_unlock,
 .irq_mask = max8998_irq_mask,
 .irq_unmask = max8998_irq_unmask,
};

static irqreturn_t max8998_irq_thread(int irq, void *data)
{
 struct max8998_dev *max8998 = data;
 u8 irq_reg[MAX8998_NUM_IRQ_REGS];
 int ret;
 int i;

 ret = max8998_bulk_read(max8998->i2c, MAX8998_REG_IRQ1,
   MAX8998_NUM_IRQ_REGS, irq_reg);
 if (ret < 0) {
  dev_err(max8998->dev, "Failed to read interrupt register: %d\n",
    ret);
  return IRQ_NONE;
 }

 /* Apply masking */
 for (i = 0; i < MAX8998_NUM_IRQ_REGS; i++)
  irq_reg[i] &= ~max8998->irq_masks_cur[i];

 /* Report */
 for (i = 0; i < MAX8998_IRQ_NR; i++) {
  if (irq_reg[max8998_irqs[i].reg - 1] & max8998_irqs[i].mask) {
   irq = irq_find_mapping(max8998->irq_domain, i);
   if (WARN_ON(!irq)) {
    disable_irq_nosync(max8998->irq);
    return IRQ_NONE;
   }
   handle_nested_irq(irq);
  }
 }

 return IRQ_HANDLED;
}

int max8998_irq_resume(struct max8998_dev *max8998)
{
 if (max8998->irq && max8998->irq_domain)
  max8998_irq_thread(max8998->irq, max8998);
 return 0;
}

static int max8998_irq_domain_map(struct irq_domain *d, unsigned int irq,
     irq_hw_number_t hw)
{
 struct max8997_dev *max8998 = d->host_data;

 irq_set_chip_data(irq, max8998);
 irq_set_chip_and_handler(irq, &max8998_irq_chip, handle_edge_irq);
 irq_set_nested_thread(irq, 1);
 irq_set_noprobe(irq);

 return 0;
}

static const struct irq_domain_ops max8998_irq_domain_ops = {
 .map = max8998_irq_domain_map,
};

int max8998_irq_init(struct max8998_dev *max8998)
{
 int i;
 int ret;
 struct irq_domain *domain;

 if (!max8998->irq) {
  dev_warn(max8998->dev,
    "No interrupt specified, no interrupts\n");
  return 0;
 }

 mutex_init(&max8998->irqlock);

 /* Mask the individual interrupt sources */
 for (i = 0; i < MAX8998_NUM_IRQ_REGS; i++) {
  max8998->irq_masks_cur[i] = 0xff;
  max8998->irq_masks_cache[i] = 0xff;
  max8998_write_reg(max8998->i2c, MAX8998_REG_IRQM1 + i, 0xff);
 }

 max8998_write_reg(max8998->i2c, MAX8998_REG_STATUSM1, 0xff);
 max8998_write_reg(max8998->i2c, MAX8998_REG_STATUSM2, 0xff);

 domain = irq_domain_create_simple(NULL, MAX8998_IRQ_NR,
   max8998->irq_base, &max8998_irq_domain_ops, max8998);
 if (!domain) {
  dev_err(max8998->dev, "could not create irq domain\n");
  return -ENODEV;
 }
 max8998->irq_domain = domain;

 ret = request_threaded_irq(max8998->irq, NULL, max8998_irq_thread,
       IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
       "max8998-irq", max8998);
 if (ret) {
  dev_err(max8998->dev, "Failed to request IRQ %d: %d\n",
   max8998->irq, ret);
  return ret;
 }

 if (!max8998->ono)
  return 0;

 ret = request_threaded_irq(max8998->ono, NULL, max8998_irq_thread,
       IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING |
       IRQF_ONESHOT, "max8998-ono", max8998);
 if (ret)
  dev_err(max8998->dev, "Failed to request IRQ %d: %d\n",
   max8998->ono, ret);

 return 0;
}

void max8998_irq_exit(struct max8998_dev *max8998)
{
 if (max8998->ono)
  free_irq(max8998->ono, max8998);

 if (max8998->irq)
  free_irq(max8998->irq, max8998);
}