Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 27b12b4e authored by Jon Hunter's avatar Jon Hunter Committed by Thierry Reding
Browse files

soc/tegra: pmc: Simplify IO rail bit handling



The function tegra_io_rail_prepare() converts the IO rail ID into a
bit position that is used to check the status and control the IO rail
in the PMC registers. However, rather than converting to a bit position
it is more useful to convert to a bit-mask because this is what is
actually used. By doing so the BIT() marco only needs to be used once
and we can use the IO_DPD_REQ_CODE_MASK when checking for erroneous rail
IDs.

Signed-off-by: default avatarJon Hunter <jonathanh@nvidia.com>
[treding@nvidia.com: rebase and rename bit -> mask]
Signed-off-by: default avatarThierry Reding <treding@nvidia.com>
parent f4392d6d
Loading
Loading
Loading
Loading
+10 −10
Original line number Diff line number Diff line
@@ -934,7 +934,7 @@ tegra_io_pad_find(struct tegra_pmc *pmc, enum tegra_io_pad id)
}

static int tegra_io_pad_prepare(enum tegra_io_pad id, unsigned long *request,
				unsigned long *status, unsigned int *bit)
				unsigned long *status, u32 *mask)
{
	const struct tegra_io_pad_soc *pad;
	unsigned long rate, value;
@@ -946,7 +946,7 @@ static int tegra_io_pad_prepare(enum tegra_io_pad id, unsigned long *request,
	if (pad->dpd == UINT_MAX)
		return -ENOTSUPP;

	*bit = pad->dpd % 32;
	*mask = BIT(pad->dpd % 32);

	if (pad->dpd < 32) {
		*status = IO_DPD_STATUS;
@@ -1002,20 +1002,20 @@ static void tegra_io_pad_unprepare(void)
int tegra_io_pad_power_enable(enum tegra_io_pad id)
{
	unsigned long request, status;
	unsigned int bit;
	u32 mask;
	int err;

	mutex_lock(&pmc->powergates_lock);

	err = tegra_io_pad_prepare(id, &request, &status, &bit);
	err = tegra_io_pad_prepare(id, &request, &status, &mask);
	if (err < 0) {
		dev_err(pmc->dev, "tegra_io_pad_prepare() failed: %d\n", err);
		goto unlock;
	}

	tegra_pmc_writel(IO_DPD_REQ_CODE_OFF | BIT(bit), request);
	tegra_pmc_writel(IO_DPD_REQ_CODE_OFF | mask, request);

	err = tegra_io_pad_poll(status, BIT(bit), 0, 250);
	err = tegra_io_pad_poll(status, mask, 0, 250);
	if (err < 0) {
		dev_err(pmc->dev, "tegra_io_pad_poll() failed: %d\n", err);
		goto unlock;
@@ -1038,20 +1038,20 @@ EXPORT_SYMBOL(tegra_io_pad_power_enable);
int tegra_io_pad_power_disable(enum tegra_io_pad id)
{
	unsigned long request, status;
	unsigned int bit;
	u32 mask;
	int err;

	mutex_lock(&pmc->powergates_lock);

	err = tegra_io_pad_prepare(id, &request, &status, &bit);
	err = tegra_io_pad_prepare(id, &request, &status, &mask);
	if (err < 0) {
		dev_err(pmc->dev, "tegra_io_pad_prepare() failed: %d\n", err);
		goto unlock;
	}

	tegra_pmc_writel(IO_DPD_REQ_CODE_ON | BIT(bit), request);
	tegra_pmc_writel(IO_DPD_REQ_CODE_ON | mask, request);

	err = tegra_io_pad_poll(status, BIT(bit), BIT(bit), 250);
	err = tegra_io_pad_poll(status, mask, mask, 250);
	if (err < 0) {
		dev_err(pmc->dev, "tegra_io_pad_poll() failed: %d\n", err);
		goto unlock;