Quelle  pmic-cpcap.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/*
 * pmic-cpcap.c - CPCAP-specific functions for the OPP code
 *
 * Adapted from Motorola Mapphone Android Linux kernel
 * Copyright (C) 2011 Motorola, Inc.
 */

#include <linux/err.h>
#include <linux/io.h>
#include <linux/kernel.h>

#include "soc.h"
#include "pm.h"
#include "voltage.h"

#include <linux/init.h>
#include "vc.h"

/**
 * omap_cpcap_vsel_to_uv - convert CPCAP VSEL value to microvolts DC
 * @vsel: CPCAP VSEL value to convert
 *
 * Returns: the microvolts DC that the CPCAP PMIC should generate when
 * programmed with @vsel.
 */
static unsigned long omap_cpcap_vsel_to_uv(unsigned char vsel)
{
 if (vsel > 0x44)
  vsel = 0x44;
 return (((vsel * 125) + 6000)) * 100;
}

/**
 * omap_cpcap_uv_to_vsel - convert microvolts DC to CPCAP VSEL value
 * @uv: microvolts DC to convert
 *
 * Returns: the VSEL value necessary for the CPCAP PMIC to
 * generate an output voltage equal to or greater than @uv microvolts DC.
 */
static unsigned char omap_cpcap_uv_to_vsel(unsigned long uv)
{
 if (uv < 600000)
  uv = 600000;
 else if (uv > 1450000)
  uv = 1450000;
 return DIV_ROUND_UP(uv - 600000, 12500);
}

static struct omap_voltdm_pmic omap_cpcap_core = {
 .slew_rate = 4000,
 .step_size = 12500,
 .vp_erroroffset = OMAP4_VP_CONFIG_ERROROFFSET,
 .vp_vstepmin = OMAP4_VP_VSTEPMIN_VSTEPMIN,
 .vp_vstepmax = OMAP4_VP_VSTEPMAX_VSTEPMAX,
 .vddmin = 900000,
 .vddmax = 1350000,
 .vp_timeout_us = OMAP4_VP_VLIMITTO_TIMEOUT_US,
 .i2c_slave_addr = 0x02,
 .volt_reg_addr = 0x00,
 .cmd_reg_addr = 0x01,
 .i2c_high_speed = false,
 .vsel_to_uv = omap_cpcap_vsel_to_uv,
 .uv_to_vsel = omap_cpcap_uv_to_vsel,
};

static struct omap_voltdm_pmic omap_cpcap_iva = {
 .slew_rate = 4000,
 .step_size = 12500,
 .vp_erroroffset = OMAP4_VP_CONFIG_ERROROFFSET,
 .vp_vstepmin = OMAP4_VP_VSTEPMIN_VSTEPMIN,
 .vp_vstepmax = OMAP4_VP_VSTEPMAX_VSTEPMAX,
 .vddmin = 900000,
 .vddmax = 1375000,
 .vp_timeout_us = OMAP4_VP_VLIMITTO_TIMEOUT_US,
 .i2c_slave_addr = 0x44,
 .volt_reg_addr = 0x0,
 .cmd_reg_addr = 0x01,
 .i2c_high_speed = false,
 .vsel_to_uv = omap_cpcap_vsel_to_uv,
 .uv_to_vsel = omap_cpcap_uv_to_vsel,
};

/**
 * omap_max8952_vsel_to_uv - convert MAX8952 VSEL value to microvolts DC
 * @vsel: MAX8952 VSEL value to convert
 *
 * Returns: the microvolts DC that the MAX8952 Regulator should generate when
 * programmed with @vsel.
 */
static unsigned long omap_max8952_vsel_to_uv(unsigned char vsel)
{
 if (vsel > 0x3F)
  vsel = 0x3F;
 return (((vsel * 100) + 7700)) * 100;
}

/**
 * omap_max8952_uv_to_vsel - convert microvolts DC to MAX8952 VSEL value
 * @uv: microvolts DC to convert
 *
 * Returns: the VSEL value necessary for the MAX8952 Regulator to
 * generate an output voltage equal to or greater than @uv microvolts DC.
 */
static unsigned char omap_max8952_uv_to_vsel(unsigned long uv)
{
 if (uv < 770000)
  uv = 770000;
 else if (uv > 1400000)
  uv = 1400000;
 return DIV_ROUND_UP(uv - 770000, 10000);
}

static struct omap_voltdm_pmic omap443x_max8952_mpu = {
 .slew_rate = 16000,
 .step_size = 10000,
 .vp_erroroffset = OMAP4_VP_CONFIG_ERROROFFSET,
 .vp_vstepmin = OMAP4_VP_VSTEPMIN_VSTEPMIN,
 .vp_vstepmax = OMAP4_VP_VSTEPMAX_VSTEPMAX,
 .vddmin = 900000,
 .vddmax = 1400000,
 .vp_timeout_us = OMAP4_VP_VLIMITTO_TIMEOUT_US,
 .i2c_slave_addr = 0x60,
 .volt_reg_addr = 0x03,
 .cmd_reg_addr = 0x03,
 .i2c_high_speed = false,
 .vsel_to_uv = omap_max8952_vsel_to_uv,
 .uv_to_vsel = omap_max8952_uv_to_vsel,
};

/**
 * omap_fan535503_vsel_to_uv - convert FAN535503 VSEL value to microvolts DC
 * @vsel: FAN535503 VSEL value to convert
 *
 * Returns: the microvolts DC that the FAN535503 Regulator should generate when
 * programmed with @vsel.
 */
static unsigned long omap_fan535503_vsel_to_uv(unsigned char vsel)
{
 /* Extract bits[5:0] */
 vsel &= 0x3F;

 return (((vsel * 125) + 7500)) * 100;
}

/**
 * omap_fan535508_vsel_to_uv - convert FAN535508 VSEL value to microvolts DC
 * @vsel: FAN535508 VSEL value to convert
 *
 * Returns: the microvolts DC that the FAN535508 Regulator should generate when
 * programmed with @vsel.
 */
static unsigned long omap_fan535508_vsel_to_uv(unsigned char vsel)
{
 /* Extract bits[5:0] */
 vsel &= 0x3F;

 if (vsel > 0x37)
  vsel = 0x37;
 return (((vsel * 125) + 7500)) * 100;
}


/**
 * omap_fan535503_uv_to_vsel - convert microvolts DC to FAN535503 VSEL value
 * @uv: microvolts DC to convert
 *
 * Returns: the VSEL value necessary for the MAX8952 Regulator to
 * generate an output voltage equal to or greater than @uv microvolts DC.
 */
static unsigned char omap_fan535503_uv_to_vsel(unsigned long uv)
{
 unsigned char vsel;
 if (uv < 750000)
  uv = 750000;
 else if (uv > 1537500)
  uv = 1537500;

 vsel = DIV_ROUND_UP(uv - 750000, 12500);
 return vsel | 0xC0;
}

/**
 * omap_fan535508_uv_to_vsel - convert microvolts DC to FAN535508 VSEL value
 * @uv: microvolts DC to convert
 *
 * Returns: the VSEL value necessary for the MAX8952 Regulator to
 * generate an output voltage equal to or greater than @uv microvolts DC.
 */
static unsigned char omap_fan535508_uv_to_vsel(unsigned long uv)
{
 unsigned char vsel;
 if (uv < 750000)
  uv = 750000;
 else if (uv > 1437500)
  uv = 1437500;

 vsel = DIV_ROUND_UP(uv - 750000, 12500);
 return vsel | 0xC0;
}

/* fan5335-core */
static struct omap_voltdm_pmic omap4_fan_core = {
 .slew_rate = 4000,
 .step_size = 12500,
 .vp_erroroffset = OMAP4_VP_CONFIG_ERROROFFSET,
 .vp_vstepmin = OMAP4_VP_VSTEPMIN_VSTEPMIN,
 .vp_vstepmax = OMAP4_VP_VSTEPMAX_VSTEPMAX,
 .vddmin = 850000,
 .vddmax = 1375000,
 .vp_timeout_us = OMAP4_VP_VLIMITTO_TIMEOUT_US,
 .i2c_slave_addr = 0x4A,
 .i2c_high_speed = false,
 .volt_reg_addr = 0x01,
 .cmd_reg_addr = 0x01,
 .vsel_to_uv = omap_fan535508_vsel_to_uv,
 .uv_to_vsel = omap_fan535508_uv_to_vsel,
};

/* fan5335 iva */
static struct omap_voltdm_pmic omap4_fan_iva = {
 .slew_rate = 4000,
 .step_size = 12500,
 .vp_erroroffset = OMAP4_VP_CONFIG_ERROROFFSET,
 .vp_vstepmin = OMAP4_VP_VSTEPMIN_VSTEPMIN,
 .vp_vstepmax = OMAP4_VP_VSTEPMAX_VSTEPMAX,
 .vddmin = 850000,
 .vddmax = 1375000,
 .vp_timeout_us = OMAP4_VP_VLIMITTO_TIMEOUT_US,
 .i2c_slave_addr = 0x48,
 .volt_reg_addr = 0x01,
 .cmd_reg_addr = 0x01,
 .i2c_high_speed = false,
 .vsel_to_uv = omap_fan535503_vsel_to_uv,
 .uv_to_vsel = omap_fan535503_uv_to_vsel,
};

int __init omap4_cpcap_init(void)
{
 struct voltagedomain *voltdm;

 if (!of_find_compatible_node(NULL, NULL, "motorola,cpcap"))
  return -ENODEV;

 voltdm = voltdm_lookup("mpu");
 omap_voltage_register_pmic(voltdm, &omap443x_max8952_mpu);

 if (of_machine_is_compatible("motorola,droid-bionic")) {
  voltdm = voltdm_lookup("core");
  omap_voltage_register_pmic(voltdm, &omap_cpcap_core);

  voltdm = voltdm_lookup("iva");
  omap_voltage_register_pmic(voltdm, &omap_cpcap_iva);
 } else {
  voltdm = voltdm_lookup("core");
  omap_voltage_register_pmic(voltdm, &omap4_fan_core);

  voltdm = voltdm_lookup("iva");
  omap_voltage_register_pmic(voltdm, &omap4_fan_iva);
 }

 return 0;
}

static int __init cpcap_late_init(void)
{
 if (!of_find_compatible_node(NULL, NULL, "motorola,cpcap"))
  return 0;

 if (soc_is_omap443x() || soc_is_omap446x() || soc_is_omap447x())
  omap4_vc_set_pmic_signaling(PWRDM_POWER_RET);

 return 0;
}
omap_late_initcall(cpcap_late_init);