|
@@ -21,10 +21,10 @@
|
|
|
|
|
|
#include <linux/delay.h>
|
|
|
#include <linux/io.h>
|
|
|
-#include <linux/clk.h>
|
|
|
#include <linux/err.h>
|
|
|
#include <linux/debugfs.h>
|
|
|
#include <linux/slab.h>
|
|
|
+#include <linux/clk.h>
|
|
|
|
|
|
#include <plat/common.h>
|
|
|
|
|
@@ -36,839 +36,88 @@
|
|
|
#include "control.h"
|
|
|
|
|
|
#include "voltage.h"
|
|
|
+#include "powerdomain.h"
|
|
|
|
|
|
#include "vc.h"
|
|
|
#include "vp.h"
|
|
|
|
|
|
-#define VOLTAGE_DIR_SIZE 16
|
|
|
-
|
|
|
-
|
|
|
-static struct omap_vdd_info **vdd_info;
|
|
|
-
|
|
|
-/*
|
|
|
- * Number of scalable voltage domains.
|
|
|
- */
|
|
|
-static int nr_scalable_vdd;
|
|
|
-
|
|
|
-/* XXX document */
|
|
|
-static s16 prm_mod_offs;
|
|
|
-static s16 prm_irqst_ocp_mod_offs;
|
|
|
-
|
|
|
-static struct dentry *voltage_dir;
|
|
|
-
|
|
|
-/* Init function pointers */
|
|
|
-static int vp_forceupdate_scale_voltage(struct omap_vdd_info *vdd,
|
|
|
- unsigned long target_volt);
|
|
|
-
|
|
|
-static u32 omap3_voltage_read_reg(u16 mod, u8 offset)
|
|
|
-{
|
|
|
- return omap2_prm_read_mod_reg(mod, offset);
|
|
|
-}
|
|
|
-
|
|
|
-static void omap3_voltage_write_reg(u32 val, u16 mod, u8 offset)
|
|
|
-{
|
|
|
- omap2_prm_write_mod_reg(val, mod, offset);
|
|
|
-}
|
|
|
-
|
|
|
-static u32 omap4_voltage_read_reg(u16 mod, u8 offset)
|
|
|
-{
|
|
|
- return omap4_prminst_read_inst_reg(OMAP4430_PRM_PARTITION,
|
|
|
- mod, offset);
|
|
|
-}
|
|
|
-
|
|
|
-static void omap4_voltage_write_reg(u32 val, u16 mod, u8 offset)
|
|
|
-{
|
|
|
- omap4_prminst_write_inst_reg(val, OMAP4430_PRM_PARTITION, mod, offset);
|
|
|
-}
|
|
|
-
|
|
|
-static int __init _config_common_vdd_data(struct omap_vdd_info *vdd)
|
|
|
-{
|
|
|
- char *sys_ck_name;
|
|
|
- struct clk *sys_ck;
|
|
|
- u32 sys_clk_speed, timeout_val, waittime;
|
|
|
-
|
|
|
- /*
|
|
|
- * XXX Clockfw should handle this, or this should be in a
|
|
|
- * struct record
|
|
|
- */
|
|
|
- if (cpu_is_omap24xx() || cpu_is_omap34xx())
|
|
|
- sys_ck_name = "sys_ck";
|
|
|
- else if (cpu_is_omap44xx())
|
|
|
- sys_ck_name = "sys_clkin_ck";
|
|
|
- else
|
|
|
- return -EINVAL;
|
|
|
-
|
|
|
- /*
|
|
|
- * Sys clk rate is require to calculate vp timeout value and
|
|
|
- * smpswaittimemin and smpswaittimemax.
|
|
|
- */
|
|
|
- sys_ck = clk_get(NULL, sys_ck_name);
|
|
|
- if (IS_ERR(sys_ck)) {
|
|
|
- pr_warning("%s: Could not get the sys clk to calculate"
|
|
|
- "various vdd_%s params\n", __func__, vdd->voltdm.name);
|
|
|
- return -EINVAL;
|
|
|
- }
|
|
|
- sys_clk_speed = clk_get_rate(sys_ck);
|
|
|
- clk_put(sys_ck);
|
|
|
- /* Divide to avoid overflow */
|
|
|
- sys_clk_speed /= 1000;
|
|
|
-
|
|
|
- /* Generic voltage parameters */
|
|
|
- vdd->volt_scale = vp_forceupdate_scale_voltage;
|
|
|
- vdd->vp_enabled = false;
|
|
|
-
|
|
|
- vdd->vp_rt_data.vpconfig_erroroffset =
|
|
|
- (vdd->pmic_info->vp_erroroffset <<
|
|
|
- vdd->vp_data->vp_common->vpconfig_erroroffset_shift);
|
|
|
-
|
|
|
- timeout_val = (sys_clk_speed * vdd->pmic_info->vp_timeout_us) / 1000;
|
|
|
- vdd->vp_rt_data.vlimitto_timeout = timeout_val;
|
|
|
- vdd->vp_rt_data.vlimitto_vddmin = vdd->pmic_info->vp_vddmin;
|
|
|
- vdd->vp_rt_data.vlimitto_vddmax = vdd->pmic_info->vp_vddmax;
|
|
|
-
|
|
|
- waittime = ((vdd->pmic_info->step_size / vdd->pmic_info->slew_rate) *
|
|
|
- sys_clk_speed) / 1000;
|
|
|
- vdd->vp_rt_data.vstepmin_smpswaittimemin = waittime;
|
|
|
- vdd->vp_rt_data.vstepmax_smpswaittimemax = waittime;
|
|
|
- vdd->vp_rt_data.vstepmin_stepmin = vdd->pmic_info->vp_vstepmin;
|
|
|
- vdd->vp_rt_data.vstepmax_stepmax = vdd->pmic_info->vp_vstepmax;
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-/* Voltage debugfs support */
|
|
|
-static int vp_volt_debug_get(void *data, u64 *val)
|
|
|
-{
|
|
|
- struct omap_vdd_info *vdd = (struct omap_vdd_info *) data;
|
|
|
- u8 vsel;
|
|
|
-
|
|
|
- if (!vdd) {
|
|
|
- pr_warning("Wrong paramater passed\n");
|
|
|
- return -EINVAL;
|
|
|
- }
|
|
|
-
|
|
|
- vsel = vdd->read_reg(prm_mod_offs, vdd->vp_data->voltage);
|
|
|
-
|
|
|
- if (!vdd->pmic_info->vsel_to_uv) {
|
|
|
- pr_warning("PMIC function to convert vsel to voltage"
|
|
|
- "in uV not registerd\n");
|
|
|
- return -EINVAL;
|
|
|
- }
|
|
|
-
|
|
|
- *val = vdd->pmic_info->vsel_to_uv(vsel);
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static int nom_volt_debug_get(void *data, u64 *val)
|
|
|
-{
|
|
|
- struct omap_vdd_info *vdd = (struct omap_vdd_info *) data;
|
|
|
-
|
|
|
- if (!vdd) {
|
|
|
- pr_warning("Wrong paramater passed\n");
|
|
|
- return -EINVAL;
|
|
|
- }
|
|
|
-
|
|
|
- *val = omap_voltage_get_nom_volt(&vdd->voltdm);
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-DEFINE_SIMPLE_ATTRIBUTE(vp_volt_debug_fops, vp_volt_debug_get, NULL, "%llu\n");
|
|
|
-DEFINE_SIMPLE_ATTRIBUTE(nom_volt_debug_fops, nom_volt_debug_get, NULL,
|
|
|
- "%llu\n");
|
|
|
-static void vp_latch_vsel(struct omap_vdd_info *vdd)
|
|
|
-{
|
|
|
- u32 vpconfig;
|
|
|
- unsigned long uvdc;
|
|
|
- char vsel;
|
|
|
-
|
|
|
- uvdc = omap_voltage_get_nom_volt(&vdd->voltdm);
|
|
|
- if (!uvdc) {
|
|
|
- pr_warning("%s: unable to find current voltage for vdd_%s\n",
|
|
|
- __func__, vdd->voltdm.name);
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- if (!vdd->pmic_info || !vdd->pmic_info->uv_to_vsel) {
|
|
|
- pr_warning("%s: PMIC function to convert voltage in uV to"
|
|
|
- " vsel not registered\n", __func__);
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- vsel = vdd->pmic_info->uv_to_vsel(uvdc);
|
|
|
-
|
|
|
- vpconfig = vdd->read_reg(prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
- vpconfig &= ~(vdd->vp_data->vp_common->vpconfig_initvoltage_mask |
|
|
|
- vdd->vp_data->vp_common->vpconfig_initvdd);
|
|
|
- vpconfig |= vsel << vdd->vp_data->vp_common->vpconfig_initvoltage_shift;
|
|
|
-
|
|
|
- vdd->write_reg(vpconfig, prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
-
|
|
|
- /* Trigger initVDD value copy to voltage processor */
|
|
|
- vdd->write_reg((vpconfig | vdd->vp_data->vp_common->vpconfig_initvdd),
|
|
|
- prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
-
|
|
|
- /* Clear initVDD copy trigger bit */
|
|
|
- vdd->write_reg(vpconfig, prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
-}
|
|
|
-
|
|
|
-/* Generic voltage init functions */
|
|
|
-static void __init vp_init(struct omap_vdd_info *vdd)
|
|
|
-{
|
|
|
- u32 vp_val;
|
|
|
-
|
|
|
- if (!vdd->read_reg || !vdd->write_reg) {
|
|
|
- pr_err("%s: No read/write API for accessing vdd_%s regs\n",
|
|
|
- __func__, vdd->voltdm.name);
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- vp_val = vdd->vp_rt_data.vpconfig_erroroffset |
|
|
|
- (vdd->vp_rt_data.vpconfig_errorgain <<
|
|
|
- vdd->vp_data->vp_common->vpconfig_errorgain_shift) |
|
|
|
- vdd->vp_data->vp_common->vpconfig_timeouten;
|
|
|
- vdd->write_reg(vp_val, prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
-
|
|
|
- vp_val = ((vdd->vp_rt_data.vstepmin_smpswaittimemin <<
|
|
|
- vdd->vp_data->vp_common->vstepmin_smpswaittimemin_shift) |
|
|
|
- (vdd->vp_rt_data.vstepmin_stepmin <<
|
|
|
- vdd->vp_data->vp_common->vstepmin_stepmin_shift));
|
|
|
- vdd->write_reg(vp_val, prm_mod_offs, vdd->vp_data->vstepmin);
|
|
|
-
|
|
|
- vp_val = ((vdd->vp_rt_data.vstepmax_smpswaittimemax <<
|
|
|
- vdd->vp_data->vp_common->vstepmax_smpswaittimemax_shift) |
|
|
|
- (vdd->vp_rt_data.vstepmax_stepmax <<
|
|
|
- vdd->vp_data->vp_common->vstepmax_stepmax_shift));
|
|
|
- vdd->write_reg(vp_val, prm_mod_offs, vdd->vp_data->vstepmax);
|
|
|
-
|
|
|
- vp_val = ((vdd->vp_rt_data.vlimitto_vddmax <<
|
|
|
- vdd->vp_data->vp_common->vlimitto_vddmax_shift) |
|
|
|
- (vdd->vp_rt_data.vlimitto_vddmin <<
|
|
|
- vdd->vp_data->vp_common->vlimitto_vddmin_shift) |
|
|
|
- (vdd->vp_rt_data.vlimitto_timeout <<
|
|
|
- vdd->vp_data->vp_common->vlimitto_timeout_shift));
|
|
|
- vdd->write_reg(vp_val, prm_mod_offs, vdd->vp_data->vlimitto);
|
|
|
-}
|
|
|
-
|
|
|
-static void __init vdd_debugfs_init(struct omap_vdd_info *vdd)
|
|
|
-{
|
|
|
- char *name;
|
|
|
-
|
|
|
- name = kzalloc(VOLTAGE_DIR_SIZE, GFP_KERNEL);
|
|
|
- if (!name) {
|
|
|
- pr_warning("%s: Unable to allocate memory for debugfs"
|
|
|
- " directory name for vdd_%s",
|
|
|
- __func__, vdd->voltdm.name);
|
|
|
- return;
|
|
|
- }
|
|
|
- strcpy(name, "vdd_");
|
|
|
- strcat(name, vdd->voltdm.name);
|
|
|
-
|
|
|
- vdd->debug_dir = debugfs_create_dir(name, voltage_dir);
|
|
|
- kfree(name);
|
|
|
- if (IS_ERR(vdd->debug_dir)) {
|
|
|
- pr_warning("%s: Unable to create debugfs directory for"
|
|
|
- " vdd_%s\n", __func__, vdd->voltdm.name);
|
|
|
- vdd->debug_dir = NULL;
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- (void) debugfs_create_x16("vp_errorgain", S_IRUGO, vdd->debug_dir,
|
|
|
- &(vdd->vp_rt_data.vpconfig_errorgain));
|
|
|
- (void) debugfs_create_x16("vp_smpswaittimemin", S_IRUGO,
|
|
|
- vdd->debug_dir,
|
|
|
- &(vdd->vp_rt_data.vstepmin_smpswaittimemin));
|
|
|
- (void) debugfs_create_x8("vp_stepmin", S_IRUGO, vdd->debug_dir,
|
|
|
- &(vdd->vp_rt_data.vstepmin_stepmin));
|
|
|
- (void) debugfs_create_x16("vp_smpswaittimemax", S_IRUGO,
|
|
|
- vdd->debug_dir,
|
|
|
- &(vdd->vp_rt_data.vstepmax_smpswaittimemax));
|
|
|
- (void) debugfs_create_x8("vp_stepmax", S_IRUGO, vdd->debug_dir,
|
|
|
- &(vdd->vp_rt_data.vstepmax_stepmax));
|
|
|
- (void) debugfs_create_x8("vp_vddmax", S_IRUGO, vdd->debug_dir,
|
|
|
- &(vdd->vp_rt_data.vlimitto_vddmax));
|
|
|
- (void) debugfs_create_x8("vp_vddmin", S_IRUGO, vdd->debug_dir,
|
|
|
- &(vdd->vp_rt_data.vlimitto_vddmin));
|
|
|
- (void) debugfs_create_x16("vp_timeout", S_IRUGO, vdd->debug_dir,
|
|
|
- &(vdd->vp_rt_data.vlimitto_timeout));
|
|
|
- (void) debugfs_create_file("curr_vp_volt", S_IRUGO, vdd->debug_dir,
|
|
|
- (void *) vdd, &vp_volt_debug_fops);
|
|
|
- (void) debugfs_create_file("curr_nominal_volt", S_IRUGO,
|
|
|
- vdd->debug_dir, (void *) vdd,
|
|
|
- &nom_volt_debug_fops);
|
|
|
-}
|
|
|
-
|
|
|
-/* Voltage scale and accessory APIs */
|
|
|
-static int _pre_volt_scale(struct omap_vdd_info *vdd,
|
|
|
- unsigned long target_volt, u8 *target_vsel, u8 *current_vsel)
|
|
|
-{
|
|
|
- struct omap_volt_data *volt_data;
|
|
|
- const struct omap_vc_common_data *vc_common;
|
|
|
- const struct omap_vp_common_data *vp_common;
|
|
|
- u32 vc_cmdval, vp_errgain_val;
|
|
|
-
|
|
|
- vc_common = vdd->vc_data->vc_common;
|
|
|
- vp_common = vdd->vp_data->vp_common;
|
|
|
-
|
|
|
- /* Check if suffiecient pmic info is available for this vdd */
|
|
|
- if (!vdd->pmic_info) {
|
|
|
- pr_err("%s: Insufficient pmic info to scale the vdd_%s\n",
|
|
|
- __func__, vdd->voltdm.name);
|
|
|
- return -EINVAL;
|
|
|
- }
|
|
|
-
|
|
|
- if (!vdd->pmic_info->uv_to_vsel) {
|
|
|
- pr_err("%s: PMIC function to convert voltage in uV to"
|
|
|
- "vsel not registered. Hence unable to scale voltage"
|
|
|
- "for vdd_%s\n", __func__, vdd->voltdm.name);
|
|
|
- return -ENODATA;
|
|
|
- }
|
|
|
-
|
|
|
- if (!vdd->read_reg || !vdd->write_reg) {
|
|
|
- pr_err("%s: No read/write API for accessing vdd_%s regs\n",
|
|
|
- __func__, vdd->voltdm.name);
|
|
|
- return -EINVAL;
|
|
|
- }
|
|
|
-
|
|
|
- /* Get volt_data corresponding to target_volt */
|
|
|
- volt_data = omap_voltage_get_voltdata(&vdd->voltdm, target_volt);
|
|
|
- if (IS_ERR(volt_data))
|
|
|
- volt_data = NULL;
|
|
|
-
|
|
|
- *target_vsel = vdd->pmic_info->uv_to_vsel(target_volt);
|
|
|
- *current_vsel = vdd->read_reg(prm_mod_offs, vdd->vp_data->voltage);
|
|
|
-
|
|
|
- /* Setting the ON voltage to the new target voltage */
|
|
|
- vc_cmdval = vdd->read_reg(prm_mod_offs, vdd->vc_data->cmdval_reg);
|
|
|
- vc_cmdval &= ~vc_common->cmd_on_mask;
|
|
|
- vc_cmdval |= (*target_vsel << vc_common->cmd_on_shift);
|
|
|
- vdd->write_reg(vc_cmdval, prm_mod_offs, vdd->vc_data->cmdval_reg);
|
|
|
-
|
|
|
- /* Setting vp errorgain based on the voltage */
|
|
|
- if (volt_data) {
|
|
|
- vp_errgain_val = vdd->read_reg(prm_mod_offs,
|
|
|
- vdd->vp_data->vpconfig);
|
|
|
- vdd->vp_rt_data.vpconfig_errorgain = volt_data->vp_errgain;
|
|
|
- vp_errgain_val &= ~vp_common->vpconfig_errorgain_mask;
|
|
|
- vp_errgain_val |= vdd->vp_rt_data.vpconfig_errorgain <<
|
|
|
- vp_common->vpconfig_errorgain_shift;
|
|
|
- vdd->write_reg(vp_errgain_val, prm_mod_offs,
|
|
|
- vdd->vp_data->vpconfig);
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static void _post_volt_scale(struct omap_vdd_info *vdd,
|
|
|
- unsigned long target_volt, u8 target_vsel, u8 current_vsel)
|
|
|
-{
|
|
|
- u32 smps_steps = 0, smps_delay = 0;
|
|
|
-
|
|
|
- smps_steps = abs(target_vsel - current_vsel);
|
|
|
- /* SMPS slew rate / step size. 2us added as buffer. */
|
|
|
- smps_delay = ((smps_steps * vdd->pmic_info->step_size) /
|
|
|
- vdd->pmic_info->slew_rate) + 2;
|
|
|
- udelay(smps_delay);
|
|
|
-
|
|
|
- vdd->curr_volt = target_volt;
|
|
|
-}
|
|
|
-
|
|
|
-/* vc_bypass_scale_voltage - VC bypass method of voltage scaling */
|
|
|
-static int vc_bypass_scale_voltage(struct omap_vdd_info *vdd,
|
|
|
- unsigned long target_volt)
|
|
|
-{
|
|
|
- u32 loop_cnt = 0, retries_cnt = 0;
|
|
|
- u32 vc_valid, vc_bypass_val_reg, vc_bypass_value;
|
|
|
- u8 target_vsel, current_vsel;
|
|
|
- int ret;
|
|
|
-
|
|
|
- ret = _pre_volt_scale(vdd, target_volt, &target_vsel, ¤t_vsel);
|
|
|
- if (ret)
|
|
|
- return ret;
|
|
|
-
|
|
|
- vc_valid = vdd->vc_data->vc_common->valid;
|
|
|
- vc_bypass_val_reg = vdd->vc_data->vc_common->bypass_val_reg;
|
|
|
- vc_bypass_value = (target_vsel << vdd->vc_data->vc_common->data_shift) |
|
|
|
- (vdd->pmic_info->pmic_reg <<
|
|
|
- vdd->vc_data->vc_common->regaddr_shift) |
|
|
|
- (vdd->pmic_info->i2c_slave_addr <<
|
|
|
- vdd->vc_data->vc_common->slaveaddr_shift);
|
|
|
-
|
|
|
- vdd->write_reg(vc_bypass_value, prm_mod_offs, vc_bypass_val_reg);
|
|
|
- vdd->write_reg(vc_bypass_value | vc_valid, prm_mod_offs,
|
|
|
- vc_bypass_val_reg);
|
|
|
-
|
|
|
- vc_bypass_value = vdd->read_reg(prm_mod_offs, vc_bypass_val_reg);
|
|
|
- /*
|
|
|
- * Loop till the bypass command is acknowledged from the SMPS.
|
|
|
- * NOTE: This is legacy code. The loop count and retry count needs
|
|
|
- * to be revisited.
|
|
|
- */
|
|
|
- while (!(vc_bypass_value & vc_valid)) {
|
|
|
- loop_cnt++;
|
|
|
-
|
|
|
- if (retries_cnt > 10) {
|
|
|
- pr_warning("%s: Retry count exceeded\n", __func__);
|
|
|
- return -ETIMEDOUT;
|
|
|
- }
|
|
|
-
|
|
|
- if (loop_cnt > 50) {
|
|
|
- retries_cnt++;
|
|
|
- loop_cnt = 0;
|
|
|
- udelay(10);
|
|
|
- }
|
|
|
- vc_bypass_value = vdd->read_reg(prm_mod_offs,
|
|
|
- vc_bypass_val_reg);
|
|
|
- }
|
|
|
-
|
|
|
- _post_volt_scale(vdd, target_volt, target_vsel, current_vsel);
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-/* VP force update method of voltage scaling */
|
|
|
-static int vp_forceupdate_scale_voltage(struct omap_vdd_info *vdd,
|
|
|
- unsigned long target_volt)
|
|
|
-{
|
|
|
- u32 vpconfig;
|
|
|
- u8 target_vsel, current_vsel, prm_irqst_reg;
|
|
|
- int ret, timeout = 0;
|
|
|
-
|
|
|
- ret = _pre_volt_scale(vdd, target_volt, &target_vsel, ¤t_vsel);
|
|
|
- if (ret)
|
|
|
- return ret;
|
|
|
-
|
|
|
- prm_irqst_reg = vdd->vp_data->prm_irqst_data->prm_irqst_reg;
|
|
|
-
|
|
|
- /*
|
|
|
- * Clear all pending TransactionDone interrupt/status. Typical latency
|
|
|
- * is <3us
|
|
|
- */
|
|
|
- while (timeout++ < VP_TRANXDONE_TIMEOUT) {
|
|
|
- vdd->write_reg(vdd->vp_data->prm_irqst_data->tranxdone_status,
|
|
|
- prm_irqst_ocp_mod_offs, prm_irqst_reg);
|
|
|
- if (!(vdd->read_reg(prm_irqst_ocp_mod_offs, prm_irqst_reg) &
|
|
|
- vdd->vp_data->prm_irqst_data->tranxdone_status))
|
|
|
- break;
|
|
|
- udelay(1);
|
|
|
- }
|
|
|
- if (timeout >= VP_TRANXDONE_TIMEOUT) {
|
|
|
- pr_warning("%s: vdd_%s TRANXDONE timeout exceeded."
|
|
|
- "Voltage change aborted", __func__, vdd->voltdm.name);
|
|
|
- return -ETIMEDOUT;
|
|
|
- }
|
|
|
-
|
|
|
- /* Configure for VP-Force Update */
|
|
|
- vpconfig = vdd->read_reg(prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
- vpconfig &= ~(vdd->vp_data->vp_common->vpconfig_initvdd |
|
|
|
- vdd->vp_data->vp_common->vpconfig_forceupdate |
|
|
|
- vdd->vp_data->vp_common->vpconfig_initvoltage_mask);
|
|
|
- vpconfig |= ((target_vsel <<
|
|
|
- vdd->vp_data->vp_common->vpconfig_initvoltage_shift));
|
|
|
- vdd->write_reg(vpconfig, prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
-
|
|
|
- /* Trigger initVDD value copy to voltage processor */
|
|
|
- vpconfig |= vdd->vp_data->vp_common->vpconfig_initvdd;
|
|
|
- vdd->write_reg(vpconfig, prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
-
|
|
|
- /* Force update of voltage */
|
|
|
- vpconfig |= vdd->vp_data->vp_common->vpconfig_forceupdate;
|
|
|
- vdd->write_reg(vpconfig, prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
-
|
|
|
- /*
|
|
|
- * Wait for TransactionDone. Typical latency is <200us.
|
|
|
- * Depends on SMPSWAITTIMEMIN/MAX and voltage change
|
|
|
- */
|
|
|
- timeout = 0;
|
|
|
- omap_test_timeout((vdd->read_reg(prm_irqst_ocp_mod_offs, prm_irqst_reg) &
|
|
|
- vdd->vp_data->prm_irqst_data->tranxdone_status),
|
|
|
- VP_TRANXDONE_TIMEOUT, timeout);
|
|
|
- if (timeout >= VP_TRANXDONE_TIMEOUT)
|
|
|
- pr_err("%s: vdd_%s TRANXDONE timeout exceeded."
|
|
|
- "TRANXDONE never got set after the voltage update\n",
|
|
|
- __func__, vdd->voltdm.name);
|
|
|
-
|
|
|
- _post_volt_scale(vdd, target_volt, target_vsel, current_vsel);
|
|
|
-
|
|
|
- /*
|
|
|
- * Disable TransactionDone interrupt , clear all status, clear
|
|
|
- * control registers
|
|
|
- */
|
|
|
- timeout = 0;
|
|
|
- while (timeout++ < VP_TRANXDONE_TIMEOUT) {
|
|
|
- vdd->write_reg(vdd->vp_data->prm_irqst_data->tranxdone_status,
|
|
|
- prm_irqst_ocp_mod_offs, prm_irqst_reg);
|
|
|
- if (!(vdd->read_reg(prm_irqst_ocp_mod_offs, prm_irqst_reg) &
|
|
|
- vdd->vp_data->prm_irqst_data->tranxdone_status))
|
|
|
- break;
|
|
|
- udelay(1);
|
|
|
- }
|
|
|
-
|
|
|
- if (timeout >= VP_TRANXDONE_TIMEOUT)
|
|
|
- pr_warning("%s: vdd_%s TRANXDONE timeout exceeded while trying"
|
|
|
- "to clear the TRANXDONE status\n",
|
|
|
- __func__, vdd->voltdm.name);
|
|
|
-
|
|
|
- vpconfig = vdd->read_reg(prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
- /* Clear initVDD copy trigger bit */
|
|
|
- vpconfig &= ~vdd->vp_data->vp_common->vpconfig_initvdd;
|
|
|
- vdd->write_reg(vpconfig, prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
- /* Clear force bit */
|
|
|
- vpconfig &= ~vdd->vp_data->vp_common->vpconfig_forceupdate;
|
|
|
- vdd->write_reg(vpconfig, prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static void __init omap3_vfsm_init(struct omap_vdd_info *vdd)
|
|
|
-{
|
|
|
- /*
|
|
|
- * Voltage Manager FSM parameters init
|
|
|
- * XXX This data should be passed in from the board file
|
|
|
- */
|
|
|
- vdd->write_reg(OMAP3_CLKSETUP, prm_mod_offs, OMAP3_PRM_CLKSETUP_OFFSET);
|
|
|
- vdd->write_reg(OMAP3_VOLTOFFSET, prm_mod_offs,
|
|
|
- OMAP3_PRM_VOLTOFFSET_OFFSET);
|
|
|
- vdd->write_reg(OMAP3_VOLTSETUP2, prm_mod_offs,
|
|
|
- OMAP3_PRM_VOLTSETUP2_OFFSET);
|
|
|
-}
|
|
|
-
|
|
|
-static void __init omap3_vc_init(struct omap_vdd_info *vdd)
|
|
|
-{
|
|
|
- static bool is_initialized;
|
|
|
- u8 on_vsel, onlp_vsel, ret_vsel, off_vsel;
|
|
|
- u32 vc_val;
|
|
|
-
|
|
|
- if (is_initialized)
|
|
|
- return;
|
|
|
-
|
|
|
- /* Set up the on, inactive, retention and off voltage */
|
|
|
- on_vsel = vdd->pmic_info->uv_to_vsel(vdd->pmic_info->on_volt);
|
|
|
- onlp_vsel = vdd->pmic_info->uv_to_vsel(vdd->pmic_info->onlp_volt);
|
|
|
- ret_vsel = vdd->pmic_info->uv_to_vsel(vdd->pmic_info->ret_volt);
|
|
|
- off_vsel = vdd->pmic_info->uv_to_vsel(vdd->pmic_info->off_volt);
|
|
|
- vc_val = ((on_vsel << vdd->vc_data->vc_common->cmd_on_shift) |
|
|
|
- (onlp_vsel << vdd->vc_data->vc_common->cmd_onlp_shift) |
|
|
|
- (ret_vsel << vdd->vc_data->vc_common->cmd_ret_shift) |
|
|
|
- (off_vsel << vdd->vc_data->vc_common->cmd_off_shift));
|
|
|
- vdd->write_reg(vc_val, prm_mod_offs, vdd->vc_data->cmdval_reg);
|
|
|
-
|
|
|
- /*
|
|
|
- * Generic VC parameters init
|
|
|
- * XXX This data should be abstracted out
|
|
|
- */
|
|
|
- vdd->write_reg(OMAP3430_CMD1_MASK | OMAP3430_RAV1_MASK, prm_mod_offs,
|
|
|
- OMAP3_PRM_VC_CH_CONF_OFFSET);
|
|
|
- vdd->write_reg(OMAP3430_MCODE_SHIFT | OMAP3430_HSEN_MASK, prm_mod_offs,
|
|
|
- OMAP3_PRM_VC_I2C_CFG_OFFSET);
|
|
|
-
|
|
|
- omap3_vfsm_init(vdd);
|
|
|
-
|
|
|
- is_initialized = true;
|
|
|
-}
|
|
|
-
|
|
|
-
|
|
|
-/* OMAP4 specific voltage init functions */
|
|
|
-static void __init omap4_vc_init(struct omap_vdd_info *vdd)
|
|
|
-{
|
|
|
- static bool is_initialized;
|
|
|
- u32 vc_val;
|
|
|
-
|
|
|
- if (is_initialized)
|
|
|
- return;
|
|
|
-
|
|
|
- /* TODO: Configure setup times and CMD_VAL values*/
|
|
|
-
|
|
|
- /*
|
|
|
- * Generic VC parameters init
|
|
|
- * XXX This data should be abstracted out
|
|
|
- */
|
|
|
- vc_val = (OMAP4430_RAV_VDD_MPU_L_MASK | OMAP4430_CMD_VDD_MPU_L_MASK |
|
|
|
- OMAP4430_RAV_VDD_IVA_L_MASK | OMAP4430_CMD_VDD_IVA_L_MASK |
|
|
|
- OMAP4430_RAV_VDD_CORE_L_MASK | OMAP4430_CMD_VDD_CORE_L_MASK);
|
|
|
- vdd->write_reg(vc_val, prm_mod_offs, OMAP4_PRM_VC_CFG_CHANNEL_OFFSET);
|
|
|
-
|
|
|
- /* XXX These are magic numbers and do not belong! */
|
|
|
- vc_val = (0x60 << OMAP4430_SCLL_SHIFT | 0x26 << OMAP4430_SCLH_SHIFT);
|
|
|
- vdd->write_reg(vc_val, prm_mod_offs, OMAP4_PRM_VC_CFG_I2C_CLK_OFFSET);
|
|
|
-
|
|
|
- is_initialized = true;
|
|
|
-}
|
|
|
-
|
|
|
-static void __init omap_vc_init(struct omap_vdd_info *vdd)
|
|
|
-{
|
|
|
- u32 vc_val;
|
|
|
-
|
|
|
- if (!vdd->pmic_info || !vdd->pmic_info->uv_to_vsel) {
|
|
|
- pr_err("%s: PMIC info requried to configure vc for"
|
|
|
- "vdd_%s not populated.Hence cannot initialize vc\n",
|
|
|
- __func__, vdd->voltdm.name);
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- if (!vdd->read_reg || !vdd->write_reg) {
|
|
|
- pr_err("%s: No read/write API for accessing vdd_%s regs\n",
|
|
|
- __func__, vdd->voltdm.name);
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- /* Set up the SMPS_SA(i2c slave address in VC */
|
|
|
- vc_val = vdd->read_reg(prm_mod_offs,
|
|
|
- vdd->vc_data->vc_common->smps_sa_reg);
|
|
|
- vc_val &= ~vdd->vc_data->smps_sa_mask;
|
|
|
- vc_val |= vdd->pmic_info->i2c_slave_addr << vdd->vc_data->smps_sa_shift;
|
|
|
- vdd->write_reg(vc_val, prm_mod_offs,
|
|
|
- vdd->vc_data->vc_common->smps_sa_reg);
|
|
|
-
|
|
|
- /* Setup the VOLRA(pmic reg addr) in VC */
|
|
|
- vc_val = vdd->read_reg(prm_mod_offs,
|
|
|
- vdd->vc_data->vc_common->smps_volra_reg);
|
|
|
- vc_val &= ~vdd->vc_data->smps_volra_mask;
|
|
|
- vc_val |= vdd->pmic_info->pmic_reg << vdd->vc_data->smps_volra_shift;
|
|
|
- vdd->write_reg(vc_val, prm_mod_offs,
|
|
|
- vdd->vc_data->vc_common->smps_volra_reg);
|
|
|
-
|
|
|
- /* Configure the setup times */
|
|
|
- vc_val = vdd->read_reg(prm_mod_offs, vdd->vfsm->voltsetup_reg);
|
|
|
- vc_val &= ~vdd->vfsm->voltsetup_mask;
|
|
|
- vc_val |= vdd->pmic_info->volt_setup_time <<
|
|
|
- vdd->vfsm->voltsetup_shift;
|
|
|
- vdd->write_reg(vc_val, prm_mod_offs, vdd->vfsm->voltsetup_reg);
|
|
|
-
|
|
|
- if (cpu_is_omap34xx())
|
|
|
- omap3_vc_init(vdd);
|
|
|
- else if (cpu_is_omap44xx())
|
|
|
- omap4_vc_init(vdd);
|
|
|
-}
|
|
|
-
|
|
|
-static int __init omap_vdd_data_configure(struct omap_vdd_info *vdd)
|
|
|
-{
|
|
|
- int ret = -EINVAL;
|
|
|
-
|
|
|
- if (!vdd->pmic_info) {
|
|
|
- pr_err("%s: PMIC info requried to configure vdd_%s not"
|
|
|
- "populated.Hence cannot initialize vdd_%s\n",
|
|
|
- __func__, vdd->voltdm.name, vdd->voltdm.name);
|
|
|
- goto ovdc_out;
|
|
|
- }
|
|
|
-
|
|
|
- if (IS_ERR_VALUE(_config_common_vdd_data(vdd)))
|
|
|
- goto ovdc_out;
|
|
|
-
|
|
|
- if (cpu_is_omap34xx()) {
|
|
|
- vdd->read_reg = omap3_voltage_read_reg;
|
|
|
- vdd->write_reg = omap3_voltage_write_reg;
|
|
|
- ret = 0;
|
|
|
- } else if (cpu_is_omap44xx()) {
|
|
|
- vdd->read_reg = omap4_voltage_read_reg;
|
|
|
- vdd->write_reg = omap4_voltage_write_reg;
|
|
|
- ret = 0;
|
|
|
- }
|
|
|
-
|
|
|
-ovdc_out:
|
|
|
- return ret;
|
|
|
-}
|
|
|
+static LIST_HEAD(voltdm_list);
|
|
|
|
|
|
/* Public functions */
|
|
|
/**
|
|
|
- * omap_voltage_get_nom_volt() - Gets the current non-auto-compensated voltage
|
|
|
- * @voltdm: pointer to the VDD for which current voltage info is needed
|
|
|
+ * voltdm_get_voltage() - Gets the current non-auto-compensated voltage
|
|
|
+ * @voltdm: pointer to the voltdm for which current voltage info is needed
|
|
|
*
|
|
|
- * API to get the current non-auto-compensated voltage for a VDD.
|
|
|
- * Returns 0 in case of error else returns the current voltage for the VDD.
|
|
|
+ * API to get the current non-auto-compensated voltage for a voltage domain.
|
|
|
+ * Returns 0 in case of error else returns the current voltage.
|
|
|
*/
|
|
|
-unsigned long omap_voltage_get_nom_volt(struct voltagedomain *voltdm)
|
|
|
+unsigned long voltdm_get_voltage(struct voltagedomain *voltdm)
|
|
|
{
|
|
|
- struct omap_vdd_info *vdd;
|
|
|
-
|
|
|
if (!voltdm || IS_ERR(voltdm)) {
|
|
|
pr_warning("%s: VDD specified does not exist!\n", __func__);
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
- vdd = container_of(voltdm, struct omap_vdd_info, voltdm);
|
|
|
-
|
|
|
- return vdd->curr_volt;
|
|
|
+ return voltdm->nominal_volt;
|
|
|
}
|
|
|
|
|
|
/**
|
|
|
- * omap_vp_get_curr_volt() - API to get the current vp voltage.
|
|
|
- * @voltdm: pointer to the VDD.
|
|
|
- *
|
|
|
- * This API returns the current voltage for the specified voltage processor
|
|
|
- */
|
|
|
-unsigned long omap_vp_get_curr_volt(struct voltagedomain *voltdm)
|
|
|
-{
|
|
|
- struct omap_vdd_info *vdd;
|
|
|
- u8 curr_vsel;
|
|
|
-
|
|
|
- if (!voltdm || IS_ERR(voltdm)) {
|
|
|
- pr_warning("%s: VDD specified does not exist!\n", __func__);
|
|
|
- return 0;
|
|
|
- }
|
|
|
-
|
|
|
- vdd = container_of(voltdm, struct omap_vdd_info, voltdm);
|
|
|
- if (!vdd->read_reg) {
|
|
|
- pr_err("%s: No read API for reading vdd_%s regs\n",
|
|
|
- __func__, voltdm->name);
|
|
|
- return 0;
|
|
|
- }
|
|
|
-
|
|
|
- curr_vsel = vdd->read_reg(prm_mod_offs, vdd->vp_data->voltage);
|
|
|
-
|
|
|
- if (!vdd->pmic_info || !vdd->pmic_info->vsel_to_uv) {
|
|
|
- pr_warning("%s: PMIC function to convert vsel to voltage"
|
|
|
- "in uV not registerd\n", __func__);
|
|
|
- return 0;
|
|
|
- }
|
|
|
-
|
|
|
- return vdd->pmic_info->vsel_to_uv(curr_vsel);
|
|
|
-}
|
|
|
-
|
|
|
-/**
|
|
|
- * omap_vp_enable() - API to enable a particular VP
|
|
|
- * @voltdm: pointer to the VDD whose VP is to be enabled.
|
|
|
- *
|
|
|
- * This API enables a particular voltage processor. Needed by the smartreflex
|
|
|
- * class drivers.
|
|
|
- */
|
|
|
-void omap_vp_enable(struct voltagedomain *voltdm)
|
|
|
-{
|
|
|
- struct omap_vdd_info *vdd;
|
|
|
- u32 vpconfig;
|
|
|
-
|
|
|
- if (!voltdm || IS_ERR(voltdm)) {
|
|
|
- pr_warning("%s: VDD specified does not exist!\n", __func__);
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- vdd = container_of(voltdm, struct omap_vdd_info, voltdm);
|
|
|
- if (!vdd->read_reg || !vdd->write_reg) {
|
|
|
- pr_err("%s: No read/write API for accessing vdd_%s regs\n",
|
|
|
- __func__, voltdm->name);
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- /* If VP is already enabled, do nothing. Return */
|
|
|
- if (vdd->vp_enabled)
|
|
|
- return;
|
|
|
-
|
|
|
- vp_latch_vsel(vdd);
|
|
|
-
|
|
|
- /* Enable VP */
|
|
|
- vpconfig = vdd->read_reg(prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
- vpconfig |= vdd->vp_data->vp_common->vpconfig_vpenable;
|
|
|
- vdd->write_reg(vpconfig, prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
- vdd->vp_enabled = true;
|
|
|
-}
|
|
|
-
|
|
|
-/**
|
|
|
- * omap_vp_disable() - API to disable a particular VP
|
|
|
- * @voltdm: pointer to the VDD whose VP is to be disabled.
|
|
|
- *
|
|
|
- * This API disables a particular voltage processor. Needed by the smartreflex
|
|
|
- * class drivers.
|
|
|
- */
|
|
|
-void omap_vp_disable(struct voltagedomain *voltdm)
|
|
|
-{
|
|
|
- struct omap_vdd_info *vdd;
|
|
|
- u32 vpconfig;
|
|
|
- int timeout;
|
|
|
-
|
|
|
- if (!voltdm || IS_ERR(voltdm)) {
|
|
|
- pr_warning("%s: VDD specified does not exist!\n", __func__);
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- vdd = container_of(voltdm, struct omap_vdd_info, voltdm);
|
|
|
- if (!vdd->read_reg || !vdd->write_reg) {
|
|
|
- pr_err("%s: No read/write API for accessing vdd_%s regs\n",
|
|
|
- __func__, voltdm->name);
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- /* If VP is already disabled, do nothing. Return */
|
|
|
- if (!vdd->vp_enabled) {
|
|
|
- pr_warning("%s: Trying to disable VP for vdd_%s when"
|
|
|
- "it is already disabled\n", __func__, voltdm->name);
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- /* Disable VP */
|
|
|
- vpconfig = vdd->read_reg(prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
- vpconfig &= ~vdd->vp_data->vp_common->vpconfig_vpenable;
|
|
|
- vdd->write_reg(vpconfig, prm_mod_offs, vdd->vp_data->vpconfig);
|
|
|
-
|
|
|
- /*
|
|
|
- * Wait for VP idle Typical latency is <2us. Maximum latency is ~100us
|
|
|
- */
|
|
|
- omap_test_timeout((vdd->read_reg(prm_mod_offs, vdd->vp_data->vstatus)),
|
|
|
- VP_IDLE_TIMEOUT, timeout);
|
|
|
-
|
|
|
- if (timeout >= VP_IDLE_TIMEOUT)
|
|
|
- pr_warning("%s: vdd_%s idle timedout\n",
|
|
|
- __func__, voltdm->name);
|
|
|
-
|
|
|
- vdd->vp_enabled = false;
|
|
|
-
|
|
|
- return;
|
|
|
-}
|
|
|
-
|
|
|
-/**
|
|
|
- * omap_voltage_scale_vdd() - API to scale voltage of a particular
|
|
|
- * voltage domain.
|
|
|
- * @voltdm: pointer to the VDD which is to be scaled.
|
|
|
- * @target_volt: The target voltage of the voltage domain
|
|
|
+ * voltdm_scale() - API to scale voltage of a particular voltage domain.
|
|
|
+ * @voltdm: pointer to the voltage domain which is to be scaled.
|
|
|
+ * @target_volt: The target voltage of the voltage domain
|
|
|
*
|
|
|
* This API should be called by the kernel to do the voltage scaling
|
|
|
- * for a particular voltage domain during dvfs or any other situation.
|
|
|
+ * for a particular voltage domain during DVFS.
|
|
|
*/
|
|
|
-int omap_voltage_scale_vdd(struct voltagedomain *voltdm,
|
|
|
- unsigned long target_volt)
|
|
|
+int voltdm_scale(struct voltagedomain *voltdm,
|
|
|
+ unsigned long target_volt)
|
|
|
{
|
|
|
- struct omap_vdd_info *vdd;
|
|
|
+ int ret;
|
|
|
|
|
|
if (!voltdm || IS_ERR(voltdm)) {
|
|
|
pr_warning("%s: VDD specified does not exist!\n", __func__);
|
|
|
return -EINVAL;
|
|
|
}
|
|
|
|
|
|
- vdd = container_of(voltdm, struct omap_vdd_info, voltdm);
|
|
|
-
|
|
|
- if (!vdd->volt_scale) {
|
|
|
+ if (!voltdm->scale) {
|
|
|
pr_err("%s: No voltage scale API registered for vdd_%s\n",
|
|
|
__func__, voltdm->name);
|
|
|
return -ENODATA;
|
|
|
}
|
|
|
|
|
|
- return vdd->volt_scale(vdd, target_volt);
|
|
|
+ ret = voltdm->scale(voltdm, target_volt);
|
|
|
+ if (!ret)
|
|
|
+ voltdm->nominal_volt = target_volt;
|
|
|
+
|
|
|
+ return ret;
|
|
|
}
|
|
|
|
|
|
/**
|
|
|
- * omap_voltage_reset() - Resets the voltage of a particular voltage domain
|
|
|
- * to that of the current OPP.
|
|
|
- * @voltdm: pointer to the VDD whose voltage is to be reset.
|
|
|
+ * voltdm_reset() - Resets the voltage of a particular voltage domain
|
|
|
+ * to that of the current OPP.
|
|
|
+ * @voltdm: pointer to the voltage domain whose voltage is to be reset.
|
|
|
*
|
|
|
* This API finds out the correct voltage the voltage domain is supposed
|
|
|
* to be at and resets the voltage to that level. Should be used especially
|
|
|
* while disabling any voltage compensation modules.
|
|
|
*/
|
|
|
-void omap_voltage_reset(struct voltagedomain *voltdm)
|
|
|
+void voltdm_reset(struct voltagedomain *voltdm)
|
|
|
{
|
|
|
- unsigned long target_uvdc;
|
|
|
+ unsigned long target_volt;
|
|
|
|
|
|
if (!voltdm || IS_ERR(voltdm)) {
|
|
|
pr_warning("%s: VDD specified does not exist!\n", __func__);
|
|
|
return;
|
|
|
}
|
|
|
|
|
|
- target_uvdc = omap_voltage_get_nom_volt(voltdm);
|
|
|
- if (!target_uvdc) {
|
|
|
+ target_volt = voltdm_get_voltage(voltdm);
|
|
|
+ if (!target_volt) {
|
|
|
pr_err("%s: unable to find current voltage for vdd_%s\n",
|
|
|
__func__, voltdm->name);
|
|
|
return;
|
|
|
}
|
|
|
|
|
|
- omap_voltage_scale_vdd(voltdm, target_uvdc);
|
|
|
+ voltdm_scale(voltdm, target_volt);
|
|
|
}
|
|
|
|
|
|
/**
|
|
@@ -884,18 +133,14 @@ void omap_voltage_reset(struct voltagedomain *voltdm)
|
|
|
*
|
|
|
*/
|
|
|
void omap_voltage_get_volttable(struct voltagedomain *voltdm,
|
|
|
- struct omap_volt_data **volt_data)
|
|
|
+ struct omap_volt_data **volt_data)
|
|
|
{
|
|
|
- struct omap_vdd_info *vdd;
|
|
|
-
|
|
|
if (!voltdm || IS_ERR(voltdm)) {
|
|
|
pr_warning("%s: VDD specified does not exist!\n", __func__);
|
|
|
return;
|
|
|
}
|
|
|
|
|
|
- vdd = container_of(voltdm, struct omap_vdd_info, voltdm);
|
|
|
-
|
|
|
- *volt_data = vdd->volt_data;
|
|
|
+ *volt_data = voltdm->volt_data;
|
|
|
}
|
|
|
|
|
|
/**
|
|
@@ -914,9 +159,8 @@ void omap_voltage_get_volttable(struct voltagedomain *voltdm,
|
|
|
* domain or if there is no matching entry.
|
|
|
*/
|
|
|
struct omap_volt_data *omap_voltage_get_voltdata(struct voltagedomain *voltdm,
|
|
|
- unsigned long volt)
|
|
|
+ unsigned long volt)
|
|
|
{
|
|
|
- struct omap_vdd_info *vdd;
|
|
|
int i;
|
|
|
|
|
|
if (!voltdm || IS_ERR(voltdm)) {
|
|
@@ -924,17 +168,15 @@ struct omap_volt_data *omap_voltage_get_voltdata(struct voltagedomain *voltdm,
|
|
|
return ERR_PTR(-EINVAL);
|
|
|
}
|
|
|
|
|
|
- vdd = container_of(voltdm, struct omap_vdd_info, voltdm);
|
|
|
-
|
|
|
- if (!vdd->volt_data) {
|
|
|
+ if (!voltdm->volt_data) {
|
|
|
pr_warning("%s: voltage table does not exist for vdd_%s\n",
|
|
|
__func__, voltdm->name);
|
|
|
return ERR_PTR(-ENODATA);
|
|
|
}
|
|
|
|
|
|
- for (i = 0; vdd->volt_data[i].volt_nominal != 0; i++) {
|
|
|
- if (vdd->volt_data[i].volt_nominal == volt)
|
|
|
- return &vdd->volt_data[i];
|
|
|
+ for (i = 0; voltdm->volt_data[i].volt_nominal != 0; i++) {
|
|
|
+ if (voltdm->volt_data[i].volt_nominal == volt)
|
|
|
+ return &voltdm->volt_data[i];
|
|
|
}
|
|
|
|
|
|
pr_notice("%s: Unable to match the current voltage with the voltage"
|
|
@@ -947,53 +189,24 @@ struct omap_volt_data *omap_voltage_get_voltdata(struct voltagedomain *voltdm,
|
|
|
* omap_voltage_register_pmic() - API to register PMIC specific data
|
|
|
* @voltdm: pointer to the VDD for which the PMIC specific data is
|
|
|
* to be registered
|
|
|
- * @pmic_info: the structure containing pmic info
|
|
|
+ * @pmic: the structure containing pmic info
|
|
|
*
|
|
|
* This API is to be called by the SOC/PMIC file to specify the
|
|
|
- * pmic specific info as present in omap_volt_pmic_info structure.
|
|
|
+ * pmic specific info as present in omap_voltdm_pmic structure.
|
|
|
*/
|
|
|
int omap_voltage_register_pmic(struct voltagedomain *voltdm,
|
|
|
- struct omap_volt_pmic_info *pmic_info)
|
|
|
+ struct omap_voltdm_pmic *pmic)
|
|
|
{
|
|
|
- struct omap_vdd_info *vdd;
|
|
|
-
|
|
|
if (!voltdm || IS_ERR(voltdm)) {
|
|
|
pr_warning("%s: VDD specified does not exist!\n", __func__);
|
|
|
return -EINVAL;
|
|
|
}
|
|
|
|
|
|
- vdd = container_of(voltdm, struct omap_vdd_info, voltdm);
|
|
|
-
|
|
|
- vdd->pmic_info = pmic_info;
|
|
|
+ voltdm->pmic = pmic;
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
-/**
|
|
|
- * omap_voltage_get_dbgdir() - API to get pointer to the debugfs directory
|
|
|
- * corresponding to a voltage domain.
|
|
|
- *
|
|
|
- * @voltdm: pointer to the VDD whose debug directory is required.
|
|
|
- *
|
|
|
- * This API returns pointer to the debugfs directory corresponding
|
|
|
- * to the voltage domain. Should be used by drivers requiring to
|
|
|
- * add any debug entry for a particular voltage domain. Returns NULL
|
|
|
- * in case of error.
|
|
|
- */
|
|
|
-struct dentry *omap_voltage_get_dbgdir(struct voltagedomain *voltdm)
|
|
|
-{
|
|
|
- struct omap_vdd_info *vdd;
|
|
|
-
|
|
|
- if (!voltdm || IS_ERR(voltdm)) {
|
|
|
- pr_warning("%s: VDD specified does not exist!\n", __func__);
|
|
|
- return NULL;
|
|
|
- }
|
|
|
-
|
|
|
- vdd = container_of(voltdm, struct omap_vdd_info, voltdm);
|
|
|
-
|
|
|
- return vdd->debug_dir;
|
|
|
-}
|
|
|
-
|
|
|
/**
|
|
|
* omap_change_voltscale_method() - API to change the voltage scaling method.
|
|
|
* @voltdm: pointer to the VDD whose voltage scaling method
|
|
@@ -1005,23 +218,19 @@ struct dentry *omap_voltage_get_dbgdir(struct voltagedomain *voltdm)
|
|
|
* defined in voltage.h
|
|
|
*/
|
|
|
void omap_change_voltscale_method(struct voltagedomain *voltdm,
|
|
|
- int voltscale_method)
|
|
|
+ int voltscale_method)
|
|
|
{
|
|
|
- struct omap_vdd_info *vdd;
|
|
|
-
|
|
|
if (!voltdm || IS_ERR(voltdm)) {
|
|
|
pr_warning("%s: VDD specified does not exist!\n", __func__);
|
|
|
return;
|
|
|
}
|
|
|
|
|
|
- vdd = container_of(voltdm, struct omap_vdd_info, voltdm);
|
|
|
-
|
|
|
switch (voltscale_method) {
|
|
|
case VOLTSCALE_VPFORCEUPDATE:
|
|
|
- vdd->volt_scale = vp_forceupdate_scale_voltage;
|
|
|
+ voltdm->scale = omap_vp_forceupdate_scale;
|
|
|
return;
|
|
|
case VOLTSCALE_VCBYPASS:
|
|
|
- vdd->volt_scale = vc_bypass_scale_voltage;
|
|
|
+ voltdm->scale = omap_vc_bypass_scale;
|
|
|
return;
|
|
|
default:
|
|
|
pr_warning("%s: Trying to change the method of voltage scaling"
|
|
@@ -1030,77 +239,192 @@ void omap_change_voltscale_method(struct voltagedomain *voltdm,
|
|
|
}
|
|
|
|
|
|
/**
|
|
|
- * omap_voltage_domain_lookup() - API to get the voltage domain pointer
|
|
|
- * @name: Name of the voltage domain
|
|
|
+ * omap_voltage_late_init() - Init the various voltage parameters
|
|
|
*
|
|
|
- * This API looks up in the global vdd_info struct for the
|
|
|
- * existence of voltage domain <name>. If it exists, the API returns
|
|
|
- * a pointer to the voltage domain structure corresponding to the
|
|
|
- * VDD<name>. Else retuns error pointer.
|
|
|
+ * This API is to be called in the later stages of the
|
|
|
+ * system boot to init the voltage controller and
|
|
|
+ * voltage processors.
|
|
|
*/
|
|
|
-struct voltagedomain *omap_voltage_domain_lookup(char *name)
|
|
|
+int __init omap_voltage_late_init(void)
|
|
|
{
|
|
|
- int i;
|
|
|
+ struct voltagedomain *voltdm;
|
|
|
|
|
|
- if (!vdd_info) {
|
|
|
- pr_err("%s: Voltage driver init not yet happened.Faulting!\n",
|
|
|
+ if (list_empty(&voltdm_list)) {
|
|
|
+ pr_err("%s: Voltage driver support not added\n",
|
|
|
__func__);
|
|
|
- return ERR_PTR(-EINVAL);
|
|
|
+ return -EINVAL;
|
|
|
}
|
|
|
|
|
|
- if (!name) {
|
|
|
- pr_err("%s: No name to get the votage domain!\n", __func__);
|
|
|
- return ERR_PTR(-EINVAL);
|
|
|
+ list_for_each_entry(voltdm, &voltdm_list, node) {
|
|
|
+ struct clk *sys_ck;
|
|
|
+
|
|
|
+ if (!voltdm->scalable)
|
|
|
+ continue;
|
|
|
+
|
|
|
+ sys_ck = clk_get(NULL, voltdm->sys_clk.name);
|
|
|
+ if (IS_ERR(sys_ck)) {
|
|
|
+ pr_warning("%s: Could not get sys clk.\n", __func__);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+ voltdm->sys_clk.rate = clk_get_rate(sys_ck);
|
|
|
+ WARN_ON(!voltdm->sys_clk.rate);
|
|
|
+ clk_put(sys_ck);
|
|
|
+
|
|
|
+ if (voltdm->vc) {
|
|
|
+ voltdm->scale = omap_vc_bypass_scale;
|
|
|
+ omap_vc_init_channel(voltdm);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (voltdm->vp) {
|
|
|
+ voltdm->scale = omap_vp_forceupdate_scale;
|
|
|
+ omap_vp_init(voltdm);
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
- for (i = 0; i < nr_scalable_vdd; i++) {
|
|
|
- if (!(strcmp(name, vdd_info[i]->voltdm.name)))
|
|
|
- return &vdd_info[i]->voltdm;
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static struct voltagedomain *_voltdm_lookup(const char *name)
|
|
|
+{
|
|
|
+ struct voltagedomain *voltdm, *temp_voltdm;
|
|
|
+
|
|
|
+ voltdm = NULL;
|
|
|
+
|
|
|
+ list_for_each_entry(temp_voltdm, &voltdm_list, node) {
|
|
|
+ if (!strcmp(name, temp_voltdm->name)) {
|
|
|
+ voltdm = temp_voltdm;
|
|
|
+ break;
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
- return ERR_PTR(-EINVAL);
|
|
|
+ return voltdm;
|
|
|
}
|
|
|
|
|
|
/**
|
|
|
- * omap_voltage_late_init() - Init the various voltage parameters
|
|
|
+ * voltdm_add_pwrdm - add a powerdomain to a voltagedomain
|
|
|
+ * @voltdm: struct voltagedomain * to add the powerdomain to
|
|
|
+ * @pwrdm: struct powerdomain * to associate with a voltagedomain
|
|
|
*
|
|
|
- * This API is to be called in the later stages of the
|
|
|
- * system boot to init the voltage controller and
|
|
|
- * voltage processors.
|
|
|
+ * Associate the powerdomain @pwrdm with a voltagedomain @voltdm. This
|
|
|
+ * enables the use of voltdm_for_each_pwrdm(). Returns -EINVAL if
|
|
|
+ * presented with invalid pointers; -ENOMEM if memory could not be allocated;
|
|
|
+ * or 0 upon success.
|
|
|
*/
|
|
|
-int __init omap_voltage_late_init(void)
|
|
|
+int voltdm_add_pwrdm(struct voltagedomain *voltdm, struct powerdomain *pwrdm)
|
|
|
{
|
|
|
- int i;
|
|
|
+ if (!voltdm || !pwrdm)
|
|
|
+ return -EINVAL;
|
|
|
|
|
|
- if (!vdd_info) {
|
|
|
- pr_err("%s: Voltage driver support not added\n",
|
|
|
- __func__);
|
|
|
+ pr_debug("voltagedomain: associating powerdomain %s with voltagedomain "
|
|
|
+ "%s\n", pwrdm->name, voltdm->name);
|
|
|
+
|
|
|
+ list_add(&pwrdm->voltdm_node, &voltdm->pwrdm_list);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * voltdm_for_each_pwrdm - call function for each pwrdm in a voltdm
|
|
|
+ * @voltdm: struct voltagedomain * to iterate over
|
|
|
+ * @fn: callback function *
|
|
|
+ *
|
|
|
+ * Call the supplied function @fn for each powerdomain in the
|
|
|
+ * voltagedomain @voltdm. Returns -EINVAL if presented with invalid
|
|
|
+ * pointers; or passes along the last return value of the callback
|
|
|
+ * function, which should be 0 for success or anything else to
|
|
|
+ * indicate failure.
|
|
|
+ */
|
|
|
+int voltdm_for_each_pwrdm(struct voltagedomain *voltdm,
|
|
|
+ int (*fn)(struct voltagedomain *voltdm,
|
|
|
+ struct powerdomain *pwrdm))
|
|
|
+{
|
|
|
+ struct powerdomain *pwrdm;
|
|
|
+ int ret = 0;
|
|
|
+
|
|
|
+ if (!fn)
|
|
|
return -EINVAL;
|
|
|
- }
|
|
|
|
|
|
- voltage_dir = debugfs_create_dir("voltage", NULL);
|
|
|
- if (IS_ERR(voltage_dir))
|
|
|
- pr_err("%s: Unable to create voltage debugfs main dir\n",
|
|
|
- __func__);
|
|
|
- for (i = 0; i < nr_scalable_vdd; i++) {
|
|
|
- if (omap_vdd_data_configure(vdd_info[i]))
|
|
|
- continue;
|
|
|
- omap_vc_init(vdd_info[i]);
|
|
|
- vp_init(vdd_info[i]);
|
|
|
- vdd_debugfs_init(vdd_info[i]);
|
|
|
+ list_for_each_entry(pwrdm, &voltdm->pwrdm_list, voltdm_node)
|
|
|
+ ret = (*fn)(voltdm, pwrdm);
|
|
|
+
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * voltdm_for_each - call function on each registered voltagedomain
|
|
|
+ * @fn: callback function *
|
|
|
+ *
|
|
|
+ * Call the supplied function @fn for each registered voltagedomain.
|
|
|
+ * The callback function @fn can return anything but 0 to bail out
|
|
|
+ * early from the iterator. Returns the last return value of the
|
|
|
+ * callback function, which should be 0 for success or anything else
|
|
|
+ * to indicate failure; or -EINVAL if the function pointer is null.
|
|
|
+ */
|
|
|
+int voltdm_for_each(int (*fn)(struct voltagedomain *voltdm, void *user),
|
|
|
+ void *user)
|
|
|
+{
|
|
|
+ struct voltagedomain *temp_voltdm;
|
|
|
+ int ret = 0;
|
|
|
+
|
|
|
+ if (!fn)
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ list_for_each_entry(temp_voltdm, &voltdm_list, node) {
|
|
|
+ ret = (*fn)(temp_voltdm, user);
|
|
|
+ if (ret)
|
|
|
+ break;
|
|
|
}
|
|
|
|
|
|
- return 0;
|
|
|
+ return ret;
|
|
|
}
|
|
|
|
|
|
-/* XXX document */
|
|
|
-int __init omap_voltage_early_init(s16 prm_mod, s16 prm_irqst_ocp_mod,
|
|
|
- struct omap_vdd_info *omap_vdd_array[],
|
|
|
- u8 omap_vdd_count)
|
|
|
+static int _voltdm_register(struct voltagedomain *voltdm)
|
|
|
{
|
|
|
- prm_mod_offs = prm_mod;
|
|
|
- prm_irqst_ocp_mod_offs = prm_irqst_ocp_mod;
|
|
|
- vdd_info = omap_vdd_array;
|
|
|
- nr_scalable_vdd = omap_vdd_count;
|
|
|
+ if (!voltdm || !voltdm->name)
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ INIT_LIST_HEAD(&voltdm->pwrdm_list);
|
|
|
+ list_add(&voltdm->node, &voltdm_list);
|
|
|
+
|
|
|
+ pr_debug("voltagedomain: registered %s\n", voltdm->name);
|
|
|
+
|
|
|
return 0;
|
|
|
}
|
|
|
+
|
|
|
+/**
|
|
|
+ * voltdm_lookup - look up a voltagedomain by name, return a pointer
|
|
|
+ * @name: name of voltagedomain
|
|
|
+ *
|
|
|
+ * Find a registered voltagedomain by its name @name. Returns a pointer
|
|
|
+ * to the struct voltagedomain if found, or NULL otherwise.
|
|
|
+ */
|
|
|
+struct voltagedomain *voltdm_lookup(const char *name)
|
|
|
+{
|
|
|
+ struct voltagedomain *voltdm ;
|
|
|
+
|
|
|
+ if (!name)
|
|
|
+ return NULL;
|
|
|
+
|
|
|
+ voltdm = _voltdm_lookup(name);
|
|
|
+
|
|
|
+ return voltdm;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * voltdm_init - set up the voltagedomain layer
|
|
|
+ * @voltdm_list: array of struct voltagedomain pointers to register
|
|
|
+ *
|
|
|
+ * Loop through the array of voltagedomains @voltdm_list, registering all
|
|
|
+ * that are available on the current CPU. If voltdm_list is supplied
|
|
|
+ * and not null, all of the referenced voltagedomains will be
|
|
|
+ * registered. No return value.
|
|
|
+ */
|
|
|
+void voltdm_init(struct voltagedomain **voltdms)
|
|
|
+{
|
|
|
+ struct voltagedomain **v;
|
|
|
+
|
|
|
+ if (voltdms) {
|
|
|
+ for (v = voltdms; *v; v++)
|
|
|
+ _voltdm_register(*v);
|
|
|
+ }
|
|
|
+}
|