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

Commit 472dba7d authored by Ben Dooks's avatar Ben Dooks Committed by Linus Torvalds
Browse files

sm501: add power control callback 



Add callback to get or set the power control if the device has the sleep
connected to some form of GPIO.

Signed-off-by: default avatarBen Dooks <ben-linux@fluff.org>
Cc: Arnaud Patard <apatard@mandriva.com>
Signed-off-by: default avatarAndrew Morton <akpm@linux-foundation.org>
Signed-off-by: default avatarLinus Torvalds <torvalds@linux-foundation.org>
parent 717115e1

drivers/mfd/sm501.c

+31 −0
Original line number Diff line number Diff line
@@ -1138,8 +1138,31 @@ static int sm501_plat_probe(struct platform_device *dev) 
}



#ifdef CONFIG_PM



/* power management support */



static void sm501_set_power(struct sm501_devdata *sm, int on)

{

	struct sm501_platdata *pd = sm->platdata;



	if (pd == NULL)

		return;



	if (pd->get_power) {

		if (pd->get_power(sm->dev) == on) {

			dev_dbg(sm->dev, "is already %d\n", on);

			return;

		}

	}



	if (pd->set_power) {

		dev_dbg(sm->dev, "setting power to %d\n", on);



		pd->set_power(sm->dev, on);

		sm501_mdelay(sm, 10);

	}

}



static int sm501_plat_suspend(struct platform_device *pdev, pm_message_t state)

{

	struct sm501_devdata *sm = platform_get_drvdata(pdev);
@@ -1148,6 +1171,12 @@ static int sm501_plat_suspend(struct platform_device *pdev, pm_message_t state) 
	sm->pm_misc = readl(sm->regs + SM501_MISC_CONTROL);



	sm501_dump_regs(sm);



	if (sm->platdata) {

		if (sm->platdata->flags & SM501_FLAG_SUSPEND_OFF)

			sm501_set_power(sm, 0);

	}



	return 0;

}
@@ -1155,6 +1184,8 @@ static int sm501_plat_resume(struct platform_device *pdev) 
{

	struct sm501_devdata *sm = platform_get_drvdata(pdev);



	sm501_set_power(sm, 1);



	sm501_dump_regs(sm);

	sm501_dump_gate(sm);

	sm501_dump_clk(sm);

include/linux/sm501.h

+7 −0
Original line number Diff line number Diff line
@@ -157,6 +157,8 @@ struct sm501_init_gpio { 
	struct sm501_reg_init	gpio_ddr_high;

};



#define SM501_FLAG_SUSPEND_OFF		(1<<4)



/* sm501_platdata

 *

 * This is passed with the platform device to allow the board
@@ -170,6 +172,11 @@ struct sm501_platdata { 
	struct sm501_init_gpio		*init_gpiop;

	struct sm501_platdata_fb	*fb;



	int				 flags;



	int	(*get_power)(struct device *dev);

	int	(*set_power)(struct device *dev, unsigned int on);



	struct sm501_platdata_gpio_i2c	*gpio_i2c;

	unsigned int			 gpio_i2c_nr;

};