86 lines
2.2 KiB
C
86 lines
2.2 KiB
C
/*
|
|
* i.MX28 power related functions
|
|
*
|
|
* Copyright 2011 Sascha Hauer, Pengutronix <s.hauer@pengutronix.de>
|
|
* Copyright (C) 2012 Wolfram Sang, Pengutronix <w.sang@pengutronix.de>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*/
|
|
#include <common.h>
|
|
#include <io.h>
|
|
#include <stmp-device.h>
|
|
#include <errno.h>
|
|
#include <mach/imx-regs.h>
|
|
|
|
#define POWER_CTRL (IMX_POWER_BASE + 0x0)
|
|
#define POWER_CTRL_CLKGATE 0x40000000
|
|
|
|
#define POWER_VDDIOCTRL (IMX_POWER_BASE + 0x60)
|
|
|
|
#define POWER_STS (IMX_POWER_BASE + 0xc0)
|
|
#define POWER_STS_VBUSVALID 0x00000002
|
|
#define POWER_STS_BVALID 0x00000004
|
|
#define POWER_STS_AVALID 0x00000008
|
|
|
|
#define POWER_DEBUG (IMX_POWER_BASE + 0x110)
|
|
#define POWER_DEBUG_BVALIDPIOLOCK 0x00000002
|
|
#define POWER_DEBUG_AVALIDPIOLOCK 0x00000004
|
|
#define POWER_DEBUG_VBUSVALIDPIOLOCK 0x00000008
|
|
|
|
#define TRG_MASK 0x1f
|
|
|
|
int imx_get_vddio(void)
|
|
{
|
|
u32 val;
|
|
|
|
val = readl(POWER_VDDIOCTRL) & TRG_MASK;
|
|
if (val > 0x10)
|
|
val = 0x10;
|
|
|
|
return 2800000 + val * 50000;
|
|
}
|
|
|
|
int imx_set_vddio(int new_voltage_uV)
|
|
{
|
|
u32 reg, val;
|
|
|
|
if (new_voltage_uV < 2800000 || new_voltage_uV > 3600000)
|
|
return -EINVAL;
|
|
|
|
val = (new_voltage_uV - 2800000) / 50000;
|
|
reg = readl(POWER_VDDIOCTRL) & ~TRG_MASK;
|
|
writel(reg | val, POWER_VDDIOCTRL);
|
|
|
|
/*
|
|
* Wait for power to become stable. We just wait, because DC_OK can
|
|
* only detect rising voltages for DCDC. For all other cases, bootlets
|
|
* also do simple waiting, although horribly nested. We just take the
|
|
* maximum value of all cases from the bootlets and then add some.
|
|
*/
|
|
mdelay(30);
|
|
|
|
return 2800000 + val * 50000;
|
|
}
|
|
|
|
void imx_power_prepare_usbphy(void)
|
|
{
|
|
u32 reg;
|
|
|
|
/*
|
|
* Set these bits so that we can force the OTG bits high
|
|
* so the ARC core operates properly
|
|
*/
|
|
writel(POWER_CTRL_CLKGATE, POWER_CTRL + STMP_OFFSET_REG_CLR);
|
|
|
|
writel(POWER_DEBUG_VBUSVALIDPIOLOCK |
|
|
POWER_DEBUG_AVALIDPIOLOCK |
|
|
POWER_DEBUG_BVALIDPIOLOCK, POWER_DEBUG + STMP_OFFSET_REG_SET);
|
|
|
|
reg = readl(POWER_STS);
|
|
reg |= POWER_STS_BVALID | POWER_STS_AVALID | POWER_STS_VBUSVALID;
|
|
writel(reg, POWER_STS);
|
|
}
|