evie/android_kernel_oneplus_msm8998
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

adv7481: Add suspend and resume handler functions

Browse source 
Add suspend and resume handler to be called from power management
framework for driver to release clock votes prior to device goes
into sleep state. Driver requests for the necessary resources in
resume handler

CRs-Fixed: 1062576
Change-Id: Iff9e7ed7b7918f9a371453a020086f22e844d7e4
Signed-off-by: Terence Ho <terenceh@codeaurora.org>
This commit is contained in:
Terence Ho 2016-09-01 19:42:16 -04:00 • committed by Gerrit - the friendly Code Review server
parent 402e3c1d4e
commit c16c42a403
1 changed files with 99 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

99
drivers/media/i2c/adv7481.c
View file

@ -116,6 +116,7 @@ struct adv7481_state {
int device_num;
int powerup;
int cec_detected;
int clocks_requested;
/* GPIOs */
struct gpio gpio_array[ADV7481_GPIO_MAX];
@ -423,6 +424,59 @@ static irqreturn_t adv7481_irq(int irq, void *dev)
return IRQ_HANDLED;
}
/* Request CCI clocks for adv7481 register access */
static int adv7481_request_cci_clks(struct adv7481_state *state)
{
int ret = 0;
if (state->clocks_requested == TRUE)
return ret;
ret = state->i2c_client.i2c_func_tbl->i2c_util(
&state->i2c_client, MSM_CCI_INIT);
if (ret < 0)
pr_err("%s - cci_init failed\n", __func__);
else
state->clocks_requested = TRUE;
/* enable camera voltage regulator */
ret = msm_camera_enable_vreg(state->dev, state->cci_vreg,
state->regulator_count, NULL, 0,
&state->cci_reg_ptr[0], 1);
if (ret < 0)
pr_err("%s:cci enable_vreg failed\n", __func__);
else
pr_debug("%s - VREG Initialized...\n", __func__);
return ret;
}
static int adv7481_release_cci_clks(struct adv7481_state *state)
{
int ret = 0;
if (state->clocks_requested == FALSE)
return ret;
ret = state->i2c_client.i2c_func_tbl->i2c_util(
&state->i2c_client, MSM_CCI_RELEASE);
if (ret < 0)
pr_err("%s - cci_release failed\n", __func__);
else
state->clocks_requested = FALSE;
/* disable camera voltage regulator */
ret = msm_camera_enable_vreg(state->dev, state->cci_vreg,
state->regulator_count, NULL, 0,
&state->cci_reg_ptr[0], 0);
if (ret < 0)
pr_err("%s:cci disable vreg failed\n", __func__);
else
pr_debug("%s - VREG Initialized...\n", __func__);
return ret;
}
static void adv7481_irq_delay_work(struct work_struct *work)
{
struct adv7481_state *state;
@ -2144,6 +2198,8 @@ static int adv7481_cci_init(struct adv7481_state *state)
&state->i2c_client, MSM_CCI_INIT);
if (ret < 0)
pr_err("%s - cci_init failed\n", __func__);
else
state->clocks_requested = TRUE;
pr_debug("%s i2c_client.client: %p\n", __func__,
state->i2c_client.client);
@ -2360,11 +2416,54 @@ static int adv7481_remove(struct platform_device *pdev)
return 0;
}
#ifdef CONFIG_PM_SLEEP
static int adv7481_suspend(struct device *dev)
{
struct adv7481_state *state;
int ret;
state = (struct adv7481_state *)dev_get_drvdata(dev);
/* release CCI clocks */
ret = adv7481_release_cci_clks(state);
if (ret)
pr_err("%s: adv7481 release cci clocks failed\n", __func__);
else
pr_debug("released cci clocks in suspend");
return 0;
}
static int adv7481_resume(struct device *dev)
{
struct adv7481_state *state;
int ret;
state = (struct adv7481_state *)dev_get_drvdata(dev);
/* Request CCI clocks */
ret = adv7481_request_cci_clks(state);
if (ret)
pr_err("%s: adv7481 request cci clocks failed\n", __func__);
else
pr_debug("requested cci clocks in resume");
return 0;
}
static SIMPLE_DEV_PM_OPS(adv7481_pm_ops, adv7481_suspend, adv7481_resume);
#define ADV7481_PM_OPS (&adv7481_pm_ops)
#else
#define ADV7481_PM_OPS NULL
#endif
static struct platform_driver adv7481_driver = {
.driver = {
.owner = THIS_MODULE,
.name = KBUILD_MODNAME,
.of_match_table = adv7481_id,
.pm = ADV7481_PM_OPS,
},
.probe = adv7481_probe,
.remove = adv7481_remove,