Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit f3151ab4 authored by Henry Chen's avatar Henry Chen Committed by Lee Jones
Browse files

mfd: mt6397: Implement wake handler and suspend/resume to handle wake up event 



Implement .irq_set_wake() to get who is wakeup source and setup on suspend/reumse. Enable
mt6393_irq as wake up source properly to pinctrl by enable_irq_wake()/enable_irq_wake().

Signed-off-by: default avatarHenry Chen <henryc.chen@mediatek.com>
Signed-off-by: default avatarLee Jones <lee.jones@linaro.org>
parent d9c93f5d

drivers/mfd/mt6397-core.c

+49 −0
Original line number Diff line number Diff line
@@ -93,12 +93,31 @@ static void mt6397_irq_enable(struct irq_data *data) 
	mt6397->irq_masks_cur[reg] |= BIT(shift);

}



#ifdef CONFIG_PM_SLEEP

static int mt6397_irq_set_wake(struct irq_data *irq_data, unsigned int on)

{

	struct mt6397_chip *mt6397 = irq_data_get_irq_chip_data(irq_data);

	int shift = irq_data->hwirq & 0xf;

	int reg = irq_data->hwirq >> 4;



	if (on)

		mt6397->wake_mask[reg] |= BIT(shift);

	else

		mt6397->wake_mask[reg] &= ~BIT(shift);



	return 0;

}

#else

#define mt6397_irq_set_wake NULL

#endif



static struct irq_chip mt6397_irq_chip = {

	.name = "mt6397-irq",

	.irq_bus_lock = mt6397_irq_lock,

	.irq_bus_sync_unlock = mt6397_irq_sync_unlock,

	.irq_enable = mt6397_irq_enable,

	.irq_disable = mt6397_irq_disable,

	.irq_set_wake = mt6397_irq_set_wake,

};



static void mt6397_irq_handle_reg(struct mt6397_chip *mt6397, int reg,
@@ -179,6 +198,35 @@ static int mt6397_irq_init(struct mt6397_chip *mt6397) 
	return 0;

}



#ifdef CONFIG_PM_SLEEP

static int mt6397_irq_suspend(struct device *dev)

{

	struct mt6397_chip *chip = dev_get_drvdata(dev);



	regmap_write(chip->regmap, MT6397_INT_CON0, chip->wake_mask[0]);

	regmap_write(chip->regmap, MT6397_INT_CON1, chip->wake_mask[1]);



	enable_irq_wake(chip->irq);



	return 0;

}



static int mt6397_irq_resume(struct device *dev)

{

	struct mt6397_chip *chip = dev_get_drvdata(dev);



	regmap_write(chip->regmap, MT6397_INT_CON0, chip->irq_masks_cur[0]);

	regmap_write(chip->regmap, MT6397_INT_CON1, chip->irq_masks_cur[1]);



	disable_irq_wake(chip->irq);



	return 0;

}

#endif



static SIMPLE_DEV_PM_OPS(mt6397_pm_ops, mt6397_irq_suspend,

			mt6397_irq_resume);



static int mt6397_probe(struct platform_device *pdev)

{

	int ret;
@@ -233,6 +281,7 @@ static struct platform_driver mt6397_driver = { 
	.driver = {

		.name = "mt6397",

		.of_match_table = of_match_ptr(mt6397_of_match),

		.pm = &mt6397_pm_ops,

	},

};

include/linux/mfd/mt6397/core.h

+1 −0
Original line number Diff line number Diff line
@@ -57,6 +57,7 @@ struct mt6397_chip { 
	int irq;

	struct irq_domain *irq_domain;

	struct mutex irqlock;

	u16 wake_mask[2];

	u16 irq_masks_cur[2];

	u16 irq_masks_cache[2];

};