Commit d59b6056 authored by Roger Quadros's avatar Roger Quadros Committed by Tony Lindgren
Browse files

bus: ti-sysc: Add generic enable/disable functions 



For non legacy cases, add generic sysc_enable_module()
and sysc_disable_module() functions.

Signed-off-by: default avatarRoger Quadros <rogerq@ti.com>
Signed-off-by: default avatarTony Lindgren <tony@atomide.com>
parent d80caf95

drivers/bus/ti-sysc.c

+129 −0
Original line number Diff line number Diff line
@@ -793,6 +793,127 @@ static void sysc_show_registers(struct sysc *ddata) 
		buf);

}



#define SYSC_IDLE_MASK	(SYSC_NR_IDLEMODES - 1)



static int sysc_enable_module(struct device *dev)

{

	struct sysc *ddata;

	const struct sysc_regbits *regbits;

	u32 reg, idlemodes, best_mode;



	ddata = dev_get_drvdata(dev);

	if (ddata->offsets[SYSC_SYSCONFIG] == -ENODEV)

		return 0;



	/*

	 * TODO: Need to prevent clockdomain autoidle?

	 * See clkdm_deny_idle() in arch/mach-omap2/omap_hwmod.c

	 */



	regbits = ddata->cap->regbits;

	reg = sysc_read(ddata, ddata->offsets[SYSC_SYSCONFIG]);



	/* Set SIDLE mode */

	idlemodes = ddata->cfg.sidlemodes;

	if (!idlemodes || regbits->sidle_shift < 0)

		goto set_midle;



	best_mode = fls(ddata->cfg.sidlemodes) - 1;

	if (best_mode > SYSC_IDLE_MASK) {

		dev_err(dev, "%s: invalid sidlemode\n", __func__);

		return -EINVAL;

	}



	reg &= ~(SYSC_IDLE_MASK << regbits->sidle_shift);

	reg |= best_mode << regbits->sidle_shift;

	sysc_write(ddata, ddata->offsets[SYSC_SYSCONFIG], reg);



set_midle:

	/* Set MIDLE mode */

	idlemodes = ddata->cfg.midlemodes;

	if (!idlemodes || regbits->midle_shift < 0)

		return 0;



	best_mode = fls(ddata->cfg.midlemodes) - 1;

	if (best_mode > SYSC_IDLE_MASK) {

		dev_err(dev, "%s: invalid midlemode\n", __func__);

		return -EINVAL;

	}



	reg &= ~(SYSC_IDLE_MASK << regbits->midle_shift);

	reg |= best_mode << regbits->midle_shift;

	sysc_write(ddata, ddata->offsets[SYSC_SYSCONFIG], reg);



	return 0;

}



static int sysc_best_idle_mode(u32 idlemodes, u32 *best_mode)

{

	if (idlemodes & BIT(SYSC_IDLE_SMART_WKUP))

		*best_mode = SYSC_IDLE_SMART_WKUP;

	else if (idlemodes & BIT(SYSC_IDLE_SMART))

		*best_mode = SYSC_IDLE_SMART;

	else if (idlemodes & SYSC_IDLE_FORCE)

		*best_mode = SYSC_IDLE_FORCE;

	else

		return -EINVAL;



	return 0;

}



static int sysc_disable_module(struct device *dev)

{

	struct sysc *ddata;

	const struct sysc_regbits *regbits;

	u32 reg, idlemodes, best_mode;

	int ret;



	ddata = dev_get_drvdata(dev);

	if (ddata->offsets[SYSC_SYSCONFIG] == -ENODEV)

		return 0;



	/*

	 * TODO: Need to prevent clockdomain autoidle?

	 * See clkdm_deny_idle() in arch/mach-omap2/omap_hwmod.c

	 */



	regbits = ddata->cap->regbits;

	reg = sysc_read(ddata, ddata->offsets[SYSC_SYSCONFIG]);



	/* Set MIDLE mode */

	idlemodes = ddata->cfg.midlemodes;

	if (!idlemodes || regbits->midle_shift < 0)

		goto set_sidle;



	ret = sysc_best_idle_mode(idlemodes, &best_mode);

	if (ret) {

		dev_err(dev, "%s: invalid midlemode\n", __func__);

		return ret;

	}



	reg &= ~(SYSC_IDLE_MASK << regbits->midle_shift);

	reg |= best_mode << regbits->midle_shift;

	sysc_write(ddata, ddata->offsets[SYSC_SYSCONFIG], reg);



set_sidle:

	/* Set SIDLE mode */

	idlemodes = ddata->cfg.sidlemodes;

	if (!idlemodes || regbits->sidle_shift < 0)

		return 0;



	ret = sysc_best_idle_mode(idlemodes, &best_mode);

	if (ret) {

		dev_err(dev, "%s: invalid sidlemode\n", __func__);

		return ret;

	}



	reg &= ~(SYSC_IDLE_MASK << regbits->sidle_shift);

	reg |= best_mode << regbits->sidle_shift;

	sysc_write(ddata, ddata->offsets[SYSC_SYSCONFIG], reg);



	return 0;

}



static int __maybe_unused sysc_runtime_suspend_legacy(struct device *dev,

						      struct sysc *ddata)

{
@@ -849,6 +970,10 @@ static int __maybe_unused sysc_runtime_suspend(struct device *dev) 
		error = sysc_runtime_suspend_legacy(dev, ddata);

		if (error)

			return error;

	} else {

		error = sysc_disable_module(dev);

		if (error)

			return error;

	}



	sysc_disable_main_clocks(ddata);
@@ -885,6 +1010,10 @@ static int __maybe_unused sysc_runtime_resume(struct device *dev) 
		error = sysc_runtime_resume_legacy(dev, ddata);

		if (error)

			goto err_main_clocks;

	} else {

		error = sysc_enable_module(dev);

		if (error)

			goto err_main_clocks;

	}



	ddata->enabled = true;