|
@@ -28,6 +28,7 @@
|
|
#include <linux/slab.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/mutex.h>
|
|
|
|
+#include <linux/delay.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/regulator/driver.h>
|
|
#include <linux/regulator/driver.h>
|
|
#include <linux/mfd/max8998.h>
|
|
#include <linux/mfd/max8998.h>
|
|
@@ -297,10 +298,13 @@ static int max8998_set_voltage(struct regulator_dev *rdev,
|
|
{
|
|
{
|
|
struct max8998_data *max8998 = rdev_get_drvdata(rdev);
|
|
struct max8998_data *max8998 = rdev_get_drvdata(rdev);
|
|
int min_vol = min_uV / 1000, max_vol = max_uV / 1000;
|
|
int min_vol = min_uV / 1000, max_vol = max_uV / 1000;
|
|
|
|
+ int previous_vol = 0;
|
|
const struct voltage_map_desc *desc;
|
|
const struct voltage_map_desc *desc;
|
|
int ldo = max8998_get_ldo(rdev);
|
|
int ldo = max8998_get_ldo(rdev);
|
|
int reg, shift = 0, mask, ret;
|
|
int reg, shift = 0, mask, ret;
|
|
int i = 0;
|
|
int i = 0;
|
|
|
|
+ u8 val;
|
|
|
|
+ bool en_ramp = false;
|
|
|
|
|
|
if (ldo > ARRAY_SIZE(ldo_voltage_map))
|
|
if (ldo > ARRAY_SIZE(ldo_voltage_map))
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
@@ -312,15 +316,36 @@ static int max8998_set_voltage(struct regulator_dev *rdev,
|
|
if (max_vol < desc->min || min_vol > desc->max)
|
|
if (max_vol < desc->min || min_vol > desc->max)
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
|
|
|
|
- while (desc->min + desc->step*i < max_vol &&
|
|
|
|
|
|
+ while (desc->min + desc->step*i < min_vol &&
|
|
desc->min + desc->step*i < desc->max)
|
|
desc->min + desc->step*i < desc->max)
|
|
i++;
|
|
i++;
|
|
|
|
|
|
|
|
+ if (desc->min + desc->step*i > max_vol)
|
|
|
|
+ return -EINVAL;
|
|
|
|
+
|
|
ret = max8998_get_voltage_register(rdev, ®, &shift, &mask);
|
|
ret = max8998_get_voltage_register(rdev, ®, &shift, &mask);
|
|
if (ret)
|
|
if (ret)
|
|
return ret;
|
|
return ret;
|
|
|
|
|
|
- return max8998_update_reg(max8998->iodev, reg, i<<shift, mask<<shift);
|
|
|
|
|
|
+ /* wait for RAMP_UP_DELAY if rdev is BUCK1/2 and
|
|
|
|
+ * ENRAMP is ON */
|
|
|
|
+ if (ldo == MAX8998_BUCK1 || ldo == MAX8998_BUCK2) {
|
|
|
|
+ max8998_read_reg(max8998->iodev, MAX8998_REG_ONOFF4, &val);
|
|
|
|
+ if (val & (1 << 4)) {
|
|
|
|
+ en_ramp = true;
|
|
|
|
+ previous_vol = max8998_get_voltage(rdev);
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ ret = max8998_update_reg(max8998->iodev, reg, i<<shift, mask<<shift);
|
|
|
|
+
|
|
|
|
+ if (en_ramp == true) {
|
|
|
|
+ int difference = desc->min + desc->step*i - previous_vol/1000;
|
|
|
|
+ if (difference > 0)
|
|
|
|
+ udelay(difference / ((val & 0x0f) + 1));
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return ret;
|
|
}
|
|
}
|
|
|
|
|
|
static struct regulator_ops max8998_ldo_ops = {
|
|
static struct regulator_ops max8998_ldo_ops = {
|