[linux-2.6-block.git] / arch / arm / mach-omap2 / vp.c

#include <linux/kernel.h>
#include <linux/init.h>

#include <plat/common.h>

#include "voltage.h"
#include "vp.h"
#include "prm-regbits-34xx.h"
#include "prm-regbits-44xx.h"
#include "prm44xx.h"

static void vp_latch_vsel(struct voltagedomain *voltdm)
{
	struct omap_vp_instance *vp = voltdm->vp;
	u32 vpconfig;
	unsigned long uvdc;
	char vsel;

	uvdc = omap_voltage_get_nom_volt(voltdm);
	if (!uvdc) {
		pr_warning("%s: unable to find current voltage for vdd_%s\n",
			__func__, voltdm->name);
		return;
	}

	if (!voltdm->pmic || !voltdm->pmic->uv_to_vsel) {
		pr_warning("%s: PMIC function to convert voltage in uV to"
			" vsel not registered\n", __func__);
		return;
	}

	vsel = voltdm->pmic->uv_to_vsel(uvdc);

	vpconfig = voltdm->read(vp->vpconfig);
	vpconfig &= ~(vp->common->vpconfig_initvoltage_mask |
			vp->common->vpconfig_initvdd);
	vpconfig |= vsel << __ffs(vp->common->vpconfig_initvoltage_mask);
	voltdm->write(vpconfig, vp->vpconfig);

	/* Trigger initVDD value copy to voltage processor */
	voltdm->write((vpconfig | vp->common->vpconfig_initvdd),
		       vp->vpconfig);

	/* Clear initVDD copy trigger bit */
	voltdm->write(vpconfig, vp->vpconfig);
}

/* Generic voltage init functions */
void __init omap_vp_init(struct voltagedomain *voltdm)
{
	struct omap_vp_instance *vp = voltdm->vp;
	struct omap_vdd_info *vdd = voltdm->vdd;
	u32 vp_val;

	if (!voltdm->read || !voltdm->write) {
		pr_err("%s: No read/write API for accessing vdd_%s regs\n",
			__func__, voltdm->name);
		return;
	}

	vp_val = vdd->vp_rt_data.vpconfig_erroroffset |
		(vdd->vp_rt_data.vpconfig_errorgain <<
		 __ffs(vp->common->vpconfig_errorgain_mask)) |
		vp->common->vpconfig_timeouten;
	voltdm->write(vp_val, vp->vpconfig);

	vp_val = ((vdd->vp_rt_data.vstepmin_smpswaittimemin <<
		   vp->common->vstepmin_smpswaittimemin_shift) |
		  (vdd->vp_rt_data.vstepmin_stepmin <<
		   vp->common->vstepmin_stepmin_shift));
	voltdm->write(vp_val, vp->vstepmin);

	vp_val = ((vdd->vp_rt_data.vstepmax_smpswaittimemax <<
		   vp->common->vstepmax_smpswaittimemax_shift) |
		  (vdd->vp_rt_data.vstepmax_stepmax <<
		   vp->common->vstepmax_stepmax_shift));
	voltdm->write(vp_val, vp->vstepmax);

	vp_val = ((vdd->vp_rt_data.vlimitto_vddmax <<
		   vp->common->vlimitto_vddmax_shift) |
		  (vdd->vp_rt_data.vlimitto_vddmin <<
		   vp->common->vlimitto_vddmin_shift) |
		  (vdd->vp_rt_data.vlimitto_timeout <<
		   vp->common->vlimitto_timeout_shift));
	voltdm->write(vp_val, vp->vlimitto);
}

/* VP force update method of voltage scaling */
int omap_vp_forceupdate_scale(struct voltagedomain *voltdm,
			      unsigned long target_volt)
{
	struct omap_vp_instance *vp = voltdm->vp;
	u32 vpconfig;
	u8 target_vsel, current_vsel;
	int ret, timeout = 0;

	ret = omap_vc_pre_scale(voltdm, target_volt, &target_vsel, &current_vsel);
	if (ret)
		return ret;

	/*
	 * Clear all pending TransactionDone interrupt/status. Typical latency
	 * is <3us
	 */
	while (timeout++ < VP_TRANXDONE_TIMEOUT) {
		vp->common->ops->clear_txdone(vp->id);
		if (!vp->common->ops->check_txdone(vp->id))
			break;
		udelay(1);
	}
	if (timeout >= VP_TRANXDONE_TIMEOUT) {
		pr_warning("%s: vdd_%s TRANXDONE timeout exceeded."
			"Voltage change aborted", __func__, voltdm->name);
		return -ETIMEDOUT;
	}

	/* Configure for VP-Force Update */
	vpconfig = voltdm->read(vp->vpconfig);
	vpconfig &= ~(vp->common->vpconfig_initvdd |
			vp->common->vpconfig_forceupdate |
			vp->common->vpconfig_initvoltage_mask);
	vpconfig |= ((target_vsel <<
		      __ffs(vp->common->vpconfig_initvoltage_mask)));
	voltdm->write(vpconfig, vp->vpconfig);

	/* Trigger initVDD value copy to voltage processor */
	vpconfig |= vp->common->vpconfig_initvdd;
	voltdm->write(vpconfig, vp->vpconfig);

	/* Force update of voltage */
	vpconfig |= vp->common->vpconfig_forceupdate;
	voltdm->write(vpconfig, vp->vpconfig);

	/*
	 * Wait for TransactionDone. Typical latency is <200us.
	 * Depends on SMPSWAITTIMEMIN/MAX and voltage change
	 */
	timeout = 0;
	omap_test_timeout(vp->common->ops->check_txdone(vp->id),
			  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__, voltdm->name);

	omap_vc_post_scale(voltdm, target_volt, target_vsel, current_vsel);

	/*
	 * Disable TransactionDone interrupt , clear all status, clear
	 * control registers
	 */
	timeout = 0;
	while (timeout++ < VP_TRANXDONE_TIMEOUT) {
		vp->common->ops->clear_txdone(vp->id);
		if (!vp->common->ops->check_txdone(vp->id))
			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__, voltdm->name);

	vpconfig = voltdm->read(vp->vpconfig);
	/* Clear initVDD copy trigger bit */
	vpconfig &= ~vp->common->vpconfig_initvdd;
	voltdm->write(vpconfig, vp->vpconfig);
	/* Clear force bit */
	vpconfig &= ~vp->common->vpconfig_forceupdate;
	voltdm->write(vpconfig, vp->vpconfig);

	return 0;
}

/**
 * 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_vp_instance *vp = voltdm->vp;
	u8 curr_vsel;

	if (!voltdm || IS_ERR(voltdm)) {
		pr_warning("%s: VDD specified does not exist!\n", __func__);
		return 0;
	}

	if (!voltdm->read) {
		pr_err("%s: No read API for reading vdd_%s regs\n",
			__func__, voltdm->name);
		return 0;
	}

	curr_vsel = voltdm->read(vp->voltage);

	if (!voltdm->pmic || !voltdm->pmic->vsel_to_uv) {
		pr_warning("%s: PMIC function to convert vsel to voltage"
			"in uV not registerd\n", __func__);
		return 0;
	}

	return voltdm->pmic->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_vp_instance *vp;
	u32 vpconfig;

	if (!voltdm || IS_ERR(voltdm)) {
		pr_warning("%s: VDD specified does not exist!\n", __func__);
		return;
	}

	vp = voltdm->vp;
	if (!voltdm->read || !voltdm->write) {
		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 (vp->enabled)
		return;

	vp_latch_vsel(voltdm);

	/* Enable VP */
	vpconfig = voltdm->read(vp->vpconfig);
	vpconfig |= vp->common->vpconfig_vpenable;
	voltdm->write(vpconfig, vp->vpconfig);
	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_vp_instance *vp;
	u32 vpconfig;
	int timeout;

	if (!voltdm || IS_ERR(voltdm)) {
		pr_warning("%s: VDD specified does not exist!\n", __func__);
		return;
	}

	vp = voltdm->vp;
	if (!voltdm->read || !voltdm->write) {
		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 (!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 = voltdm->read(vp->vpconfig);
	vpconfig &= ~vp->common->vpconfig_vpenable;
	voltdm->write(vpconfig, vp->vpconfig);

	/*
	 * Wait for VP idle Typical latency is <2us. Maximum latency is ~100us
	 */
	omap_test_timeout((voltdm->read(vp->vstatus)),
			  VP_IDLE_TIMEOUT, timeout);

	if (timeout >= VP_IDLE_TIMEOUT)
		pr_warning("%s: vdd_%s idle timedout\n",
			__func__, voltdm->name);

	vp->enabled = false;

	return;
}
Commit	Line	Data
01f48d30 KH	1	#include <linux/kernel.h>
01f48d30 KH	2	#include <linux/init.h>
01f48d30 KH	3
	4	#include <plat/common.h>
	5
	6	#include "voltage.h"
	7	#include "vp.h"
	8	#include "prm-regbits-34xx.h"
	9	#include "prm-regbits-44xx.h"
	10	#include "prm44xx.h"
	11
01f48d30 KH	12	static void vp_latch_vsel(struct voltagedomain *voltdm)
01f48d30 KH	13	{
b7ea803e	14	struct omap_vp_instance *vp = voltdm->vp;
01f48d30 KH	15	u32 vpconfig;
	16	unsigned long uvdc;
	17	char vsel;
01f48d30 KH	18
	19	uvdc = omap_voltage_get_nom_volt(voltdm);
	20	if (!uvdc) {
	21	pr_warning("%s: unable to find current voltage for vdd_%s\n",
	22	__func__, voltdm->name);
	23	return;
	24	}
	25
ce8ebe0d	26	if (!voltdm->pmic \|\| !voltdm->pmic->uv_to_vsel) {
01f48d30 KH	27	pr_warning("%s: PMIC function to convert voltage in uV to"
	28	" vsel not registered\n", __func__);
	29	return;
	30	}
	31
ce8ebe0d	32	vsel = voltdm->pmic->uv_to_vsel(uvdc);
01f48d30	33
4bcc475e	34	vpconfig = voltdm->read(vp->vpconfig);
b7ea803e KH	35	vpconfig &= ~(vp->common->vpconfig_initvoltage_mask \|
b7ea803e KH	36	vp->common->vpconfig_initvdd);
0ec3041e	37	vpconfig \|= vsel << __ffs(vp->common->vpconfig_initvoltage_mask);
4bcc475e	38	voltdm->write(vpconfig, vp->vpconfig);
01f48d30 KH	39
01f48d30 KH	40	/* Trigger initVDD value copy to voltage processor */
b7ea803e	41	voltdm->write((vpconfig \| vp->common->vpconfig_initvdd),
4bcc475e	42	vp->vpconfig);
01f48d30 KH	43
01f48d30 KH	44	/* Clear initVDD copy trigger bit */
4bcc475e	45	voltdm->write(vpconfig, vp->vpconfig);
01f48d30 KH	46	}
	47
	48	/* Generic voltage init functions */
	49	void __init omap_vp_init(struct voltagedomain *voltdm)
	50	{
b7ea803e	51	struct omap_vp_instance *vp = voltdm->vp;
01f48d30 KH	52	struct omap_vdd_info *vdd = voltdm->vdd;
	53	u32 vp_val;
	54
4bcc475e	55	if (!voltdm->read \|\| !voltdm->write) {
01f48d30 KH	56	pr_err("%s: No read/write API for accessing vdd_%s regs\n",
	57	__func__, voltdm->name);
	58	return;
	59	}
	60
	61	vp_val = vdd->vp_rt_data.vpconfig_erroroffset \|
	62	(vdd->vp_rt_data.vpconfig_errorgain <<
0ec3041e	63	__ffs(vp->common->vpconfig_errorgain_mask)) \|
b7ea803e	64	vp->common->vpconfig_timeouten;
4bcc475e	65	voltdm->write(vp_val, vp->vpconfig);
01f48d30 KH	66
01f48d30 KH	67	vp_val = ((vdd->vp_rt_data.vstepmin_smpswaittimemin <<
0ec3041e KH	68	vp->common->vstepmin_smpswaittimemin_shift) \|
	69	(vdd->vp_rt_data.vstepmin_stepmin <<
	70	vp->common->vstepmin_stepmin_shift));
4bcc475e	71	voltdm->write(vp_val, vp->vstepmin);
01f48d30 KH	72
01f48d30 KH	73	vp_val = ((vdd->vp_rt_data.vstepmax_smpswaittimemax <<
0ec3041e KH	74	vp->common->vstepmax_smpswaittimemax_shift) \|
	75	(vdd->vp_rt_data.vstepmax_stepmax <<
	76	vp->common->vstepmax_stepmax_shift));
4bcc475e	77	voltdm->write(vp_val, vp->vstepmax);
01f48d30 KH	78
01f48d30 KH	79	vp_val = ((vdd->vp_rt_data.vlimitto_vddmax <<
0ec3041e KH	80	vp->common->vlimitto_vddmax_shift) \|
	81	(vdd->vp_rt_data.vlimitto_vddmin <<
	82	vp->common->vlimitto_vddmin_shift) \|
	83	(vdd->vp_rt_data.vlimitto_timeout <<
	84	vp->common->vlimitto_timeout_shift));
4bcc475e	85	voltdm->write(vp_val, vp->vlimitto);
01f48d30 KH	86	}
	87
	88	/* VP force update method of voltage scaling */
	89	int omap_vp_forceupdate_scale(struct voltagedomain *voltdm,
	90	unsigned long target_volt)
	91	{
b7ea803e	92	struct omap_vp_instance *vp = voltdm->vp;
01f48d30 KH	93	u32 vpconfig;
	94	u8 target_vsel, current_vsel;
	95	int ret, timeout = 0;
	96
	97	ret = omap_vc_pre_scale(voltdm, target_volt, &target_vsel, &current_vsel);
	98	if (ret)
	99	return ret;
	100
	101	/*
	102	* Clear all pending TransactionDone interrupt/status. Typical latency
	103	* is <3us
	104	*/
	105	while (timeout++ < VP_TRANXDONE_TIMEOUT) {
b7ea803e KH	106	vp->common->ops->clear_txdone(vp->id);
b7ea803e KH	107	if (!vp->common->ops->check_txdone(vp->id))
01f48d30 KH	108	break;
	109	udelay(1);
	110	}
	111	if (timeout >= VP_TRANXDONE_TIMEOUT) {
	112	pr_warning("%s: vdd_%s TRANXDONE timeout exceeded."
	113	"Voltage change aborted", __func__, voltdm->name);
	114	return -ETIMEDOUT;
	115	}
	116
	117	/* Configure for VP-Force Update */
4bcc475e	118	vpconfig = voltdm->read(vp->vpconfig);
b7ea803e KH	119	vpconfig &= ~(vp->common->vpconfig_initvdd \|
	120	vp->common->vpconfig_forceupdate \|
	121	vp->common->vpconfig_initvoltage_mask);
01f48d30	122	vpconfig \|= ((target_vsel <<
0ec3041e	123	__ffs(vp->common->vpconfig_initvoltage_mask)));
4bcc475e	124	voltdm->write(vpconfig, vp->vpconfig);
01f48d30 KH	125
01f48d30 KH	126	/* Trigger initVDD value copy to voltage processor */
b7ea803e	127	vpconfig \|= vp->common->vpconfig_initvdd;
4bcc475e	128	voltdm->write(vpconfig, vp->vpconfig);
01f48d30 KH	129
01f48d30 KH	130	/* Force update of voltage */
b7ea803e	131	vpconfig \|= vp->common->vpconfig_forceupdate;
4bcc475e	132	voltdm->write(vpconfig, vp->vpconfig);
01f48d30 KH	133
	134	/*
	135	* Wait for TransactionDone. Typical latency is <200us.
	136	* Depends on SMPSWAITTIMEMIN/MAX and voltage change
	137	*/
	138	timeout = 0;
b7ea803e	139	omap_test_timeout(vp->common->ops->check_txdone(vp->id),
01f48d30 KH	140	VP_TRANXDONE_TIMEOUT, timeout);
	141	if (timeout >= VP_TRANXDONE_TIMEOUT)
	142	pr_err("%s: vdd_%s TRANXDONE timeout exceeded."
	143	"TRANXDONE never got set after the voltage update\n",
	144	__func__, voltdm->name);
	145
	146	omap_vc_post_scale(voltdm, target_volt, target_vsel, current_vsel);
	147
	148	/*
	149	* Disable TransactionDone interrupt , clear all status, clear
	150	* control registers
	151	*/
	152	timeout = 0;
	153	while (timeout++ < VP_TRANXDONE_TIMEOUT) {
b7ea803e KH	154	vp->common->ops->clear_txdone(vp->id);
b7ea803e KH	155	if (!vp->common->ops->check_txdone(vp->id))
01f48d30 KH	156	break;
	157	udelay(1);
	158	}
	159
	160	if (timeout >= VP_TRANXDONE_TIMEOUT)
	161	pr_warning("%s: vdd_%s TRANXDONE timeout exceeded while trying"
	162	"to clear the TRANXDONE status\n",
	163	__func__, voltdm->name);
	164
4bcc475e	165	vpconfig = voltdm->read(vp->vpconfig);
01f48d30	166	/* Clear initVDD copy trigger bit */
b7ea803e	167	vpconfig &= ~vp->common->vpconfig_initvdd;
4bcc475e	168	voltdm->write(vpconfig, vp->vpconfig);
01f48d30	169	/* Clear force bit */
b7ea803e	170	vpconfig &= ~vp->common->vpconfig_forceupdate;
4bcc475e	171	voltdm->write(vpconfig, vp->vpconfig);
01f48d30 KH	172
	173	return 0;
	174	}
	175
	176	/**
	177	* omap_vp_get_curr_volt() - API to get the current vp voltage.
	178	* @voltdm: pointer to the VDD.
	179	*
	180	* This API returns the current voltage for the specified voltage processor
	181	*/
	182	unsigned long omap_vp_get_curr_volt(struct voltagedomain *voltdm)
	183	{
b7ea803e	184	struct omap_vp_instance *vp = voltdm->vp;
01f48d30 KH	185	u8 curr_vsel;
	186
	187	if (!voltdm \|\| IS_ERR(voltdm)) {
	188	pr_warning("%s: VDD specified does not exist!\n", __func__);
	189	return 0;
	190	}
	191
4bcc475e	192	if (!voltdm->read) {
01f48d30 KH	193	pr_err("%s: No read API for reading vdd_%s regs\n",
	194	__func__, voltdm->name);
	195	return 0;
	196	}
	197
4bcc475e	198	curr_vsel = voltdm->read(vp->voltage);
01f48d30	199
ce8ebe0d	200	if (!voltdm->pmic \|\| !voltdm->pmic->vsel_to_uv) {
01f48d30 KH	201	pr_warning("%s: PMIC function to convert vsel to voltage"
	202	"in uV not registerd\n", __func__);
	203	return 0;
	204	}
	205
ce8ebe0d	206	return voltdm->pmic->vsel_to_uv(curr_vsel);
01f48d30 KH	207	}
	208
	209	/**
	210	* omap_vp_enable() - API to enable a particular VP
	211	* @voltdm: pointer to the VDD whose VP is to be enabled.
	212	*
	213	* This API enables a particular voltage processor. Needed by the smartreflex
	214	* class drivers.
	215	*/
	216	void omap_vp_enable(struct voltagedomain *voltdm)
	217	{
b7ea803e	218	struct omap_vp_instance *vp;
01f48d30 KH	219	u32 vpconfig;
	220
	221	if (!voltdm \|\| IS_ERR(voltdm)) {
	222	pr_warning("%s: VDD specified does not exist!\n", __func__);
	223	return;
	224	}
	225
b7ea803e	226	vp = voltdm->vp;
4bcc475e	227	if (!voltdm->read \|\| !voltdm->write) {
01f48d30 KH	228	pr_err("%s: No read/write API for accessing vdd_%s regs\n",
	229	__func__, voltdm->name);
	230	return;
	231	}
	232
	233	/* If VP is already enabled, do nothing. Return */
b7ea803e	234	if (vp->enabled)
01f48d30 KH	235	return;
	236
	237	vp_latch_vsel(voltdm);
	238
	239	/* Enable VP */
4bcc475e	240	vpconfig = voltdm->read(vp->vpconfig);
b7ea803e	241	vpconfig \|= vp->common->vpconfig_vpenable;
4bcc475e	242	voltdm->write(vpconfig, vp->vpconfig);
b7ea803e	243	vp->enabled = true;
01f48d30 KH	244	}
	245
	246	/**
	247	* omap_vp_disable() - API to disable a particular VP
	248	* @voltdm: pointer to the VDD whose VP is to be disabled.
	249	*
	250	* This API disables a particular voltage processor. Needed by the smartreflex
	251	* class drivers.
	252	*/
	253	void omap_vp_disable(struct voltagedomain *voltdm)
	254	{
b7ea803e	255	struct omap_vp_instance *vp;
01f48d30 KH	256	u32 vpconfig;
	257	int timeout;
	258
	259	if (!voltdm \|\| IS_ERR(voltdm)) {
	260	pr_warning("%s: VDD specified does not exist!\n", __func__);
	261	return;
	262	}
	263
b7ea803e	264	vp = voltdm->vp;
4bcc475e	265	if (!voltdm->read \|\| !voltdm->write) {
01f48d30 KH	266	pr_err("%s: No read/write API for accessing vdd_%s regs\n",
	267	__func__, voltdm->name);
	268	return;
	269	}
	270
	271	/* If VP is already disabled, do nothing. Return */
b7ea803e	272	if (!vp->enabled) {
01f48d30 KH	273	pr_warning("%s: Trying to disable VP for vdd_%s when"
	274	"it is already disabled\n", __func__, voltdm->name);
	275	return;
	276	}
	277
	278	/* Disable VP */
4bcc475e	279	vpconfig = voltdm->read(vp->vpconfig);
b7ea803e	280	vpconfig &= ~vp->common->vpconfig_vpenable;
4bcc475e	281	voltdm->write(vpconfig, vp->vpconfig);
01f48d30 KH	282
	283	/*
	284	* Wait for VP idle Typical latency is <2us. Maximum latency is ~100us
	285	*/
4bcc475e KH	286	omap_test_timeout((voltdm->read(vp->vstatus)),
4bcc475e KH	287	VP_IDLE_TIMEOUT, timeout);
01f48d30 KH	288
	289	if (timeout >= VP_IDLE_TIMEOUT)
	290	pr_warning("%s: vdd_%s idle timedout\n",
	291	__func__, voltdm->name);
	292
b7ea803e	293	vp->enabled = false;
01f48d30 KH	294
	295	return;
	296	}