|
@@ -82,6 +82,7 @@
|
|
|
* will also impact the individual peripheral rates.
|
|
|
*/
|
|
|
|
|
|
+#include <linux/export.h>
|
|
|
#include <linux/kernel.h>
|
|
|
#include <linux/list.h>
|
|
|
#include <linux/errno.h>
|
|
@@ -97,9 +98,10 @@
|
|
|
#include "clock.h"
|
|
|
#include "common.h"
|
|
|
|
|
|
+static DEFINE_SPINLOCK(global_clkregs_lock);
|
|
|
+
|
|
|
static struct clk clk_armpll;
|
|
|
static struct clk clk_usbpll;
|
|
|
-static DEFINE_MUTEX(clkm_lock);
|
|
|
|
|
|
/*
|
|
|
* Post divider values for PLLs based on selected register value
|
|
@@ -127,7 +129,7 @@ static struct clk osc_32KHz = {
|
|
|
static int local_pll397_enable(struct clk *clk, int enable)
|
|
|
{
|
|
|
u32 reg;
|
|
|
- unsigned long timeout = 1 + msecs_to_jiffies(10);
|
|
|
+ unsigned long timeout = jiffies + msecs_to_jiffies(10);
|
|
|
|
|
|
reg = __raw_readl(LPC32XX_CLKPWR_PLL397_CTRL);
|
|
|
|
|
@@ -142,7 +144,7 @@ static int local_pll397_enable(struct clk *clk, int enable)
|
|
|
/* Wait for PLL397 lock */
|
|
|
while (((__raw_readl(LPC32XX_CLKPWR_PLL397_CTRL) &
|
|
|
LPC32XX_CLKPWR_SYSCTRL_PLL397_STS) == 0) &&
|
|
|
- (timeout > jiffies))
|
|
|
+ time_before(jiffies, timeout))
|
|
|
cpu_relax();
|
|
|
|
|
|
if ((__raw_readl(LPC32XX_CLKPWR_PLL397_CTRL) &
|
|
@@ -156,7 +158,7 @@ static int local_pll397_enable(struct clk *clk, int enable)
|
|
|
static int local_oscmain_enable(struct clk *clk, int enable)
|
|
|
{
|
|
|
u32 reg;
|
|
|
- unsigned long timeout = 1 + msecs_to_jiffies(10);
|
|
|
+ unsigned long timeout = jiffies + msecs_to_jiffies(10);
|
|
|
|
|
|
reg = __raw_readl(LPC32XX_CLKPWR_MAIN_OSC_CTRL);
|
|
|
|
|
@@ -171,7 +173,7 @@ static int local_oscmain_enable(struct clk *clk, int enable)
|
|
|
/* Wait for main oscillator to start */
|
|
|
while (((__raw_readl(LPC32XX_CLKPWR_MAIN_OSC_CTRL) &
|
|
|
LPC32XX_CLKPWR_MOSC_DISABLE) != 0) &&
|
|
|
- (timeout > jiffies))
|
|
|
+ time_before(jiffies, timeout))
|
|
|
cpu_relax();
|
|
|
|
|
|
if ((__raw_readl(LPC32XX_CLKPWR_MAIN_OSC_CTRL) &
|
|
@@ -383,7 +385,7 @@ static int local_usbpll_enable(struct clk *clk, int enable)
|
|
|
{
|
|
|
u32 reg;
|
|
|
int ret = -ENODEV;
|
|
|
- unsigned long timeout = 1 + msecs_to_jiffies(10);
|
|
|
+ unsigned long timeout = jiffies + msecs_to_jiffies(10);
|
|
|
|
|
|
reg = __raw_readl(LPC32XX_CLKPWR_USB_CTRL);
|
|
|
|
|
@@ -396,7 +398,7 @@ static int local_usbpll_enable(struct clk *clk, int enable)
|
|
|
__raw_writel(reg, LPC32XX_CLKPWR_USB_CTRL);
|
|
|
|
|
|
/* Wait for PLL lock */
|
|
|
- while ((timeout > jiffies) & (ret == -ENODEV)) {
|
|
|
+ while (time_before(jiffies, timeout) && (ret == -ENODEV)) {
|
|
|
reg = __raw_readl(LPC32XX_CLKPWR_USB_CTRL);
|
|
|
if (reg & LPC32XX_CLKPWR_USBCTRL_PLL_STS)
|
|
|
ret = 0;
|
|
@@ -926,20 +928,8 @@ static struct clk clk_lcd = {
|
|
|
.enable_mask = LPC32XX_CLKPWR_LCDCTRL_CLK_EN,
|
|
|
};
|
|
|
|
|
|
-static inline void clk_lock(void)
|
|
|
-{
|
|
|
- mutex_lock(&clkm_lock);
|
|
|
-}
|
|
|
-
|
|
|
-static inline void clk_unlock(void)
|
|
|
-{
|
|
|
- mutex_unlock(&clkm_lock);
|
|
|
-}
|
|
|
-
|
|
|
static void local_clk_disable(struct clk *clk)
|
|
|
{
|
|
|
- WARN_ON(clk->usecount == 0);
|
|
|
-
|
|
|
/* Don't attempt to disable clock if it has no users */
|
|
|
if (clk->usecount > 0) {
|
|
|
clk->usecount--;
|
|
@@ -982,10 +972,11 @@ static int local_clk_enable(struct clk *clk)
|
|
|
int clk_enable(struct clk *clk)
|
|
|
{
|
|
|
int ret;
|
|
|
+ unsigned long flags;
|
|
|
|
|
|
- clk_lock();
|
|
|
+ spin_lock_irqsave(&global_clkregs_lock, flags);
|
|
|
ret = local_clk_enable(clk);
|
|
|
- clk_unlock();
|
|
|
+ spin_unlock_irqrestore(&global_clkregs_lock, flags);
|
|
|
|
|
|
return ret;
|
|
|
}
|
|
@@ -996,9 +987,11 @@ EXPORT_SYMBOL(clk_enable);
|
|
|
*/
|
|
|
void clk_disable(struct clk *clk)
|
|
|
{
|
|
|
- clk_lock();
|
|
|
+ unsigned long flags;
|
|
|
+
|
|
|
+ spin_lock_irqsave(&global_clkregs_lock, flags);
|
|
|
local_clk_disable(clk);
|
|
|
- clk_unlock();
|
|
|
+ spin_unlock_irqrestore(&global_clkregs_lock, flags);
|
|
|
}
|
|
|
EXPORT_SYMBOL(clk_disable);
|
|
|
|
|
@@ -1007,13 +1000,7 @@ EXPORT_SYMBOL(clk_disable);
|
|
|
*/
|
|
|
unsigned long clk_get_rate(struct clk *clk)
|
|
|
{
|
|
|
- unsigned long rate;
|
|
|
-
|
|
|
- clk_lock();
|
|
|
- rate = clk->get_rate(clk);
|
|
|
- clk_unlock();
|
|
|
-
|
|
|
- return rate;
|
|
|
+ return clk->get_rate(clk);
|
|
|
}
|
|
|
EXPORT_SYMBOL(clk_get_rate);
|
|
|
|
|
@@ -1029,11 +1016,8 @@ int clk_set_rate(struct clk *clk, unsigned long rate)
|
|
|
* the actual rate set as part of the peripheral dividers
|
|
|
* instead of high level clock control
|
|
|
*/
|
|
|
- if (clk->set_rate) {
|
|
|
- clk_lock();
|
|
|
+ if (clk->set_rate)
|
|
|
ret = clk->set_rate(clk, rate);
|
|
|
- clk_unlock();
|
|
|
- }
|
|
|
|
|
|
return ret;
|
|
|
}
|
|
@@ -1044,15 +1028,11 @@ EXPORT_SYMBOL(clk_set_rate);
|
|
|
*/
|
|
|
long clk_round_rate(struct clk *clk, unsigned long rate)
|
|
|
{
|
|
|
- clk_lock();
|
|
|
-
|
|
|
if (clk->round_rate)
|
|
|
rate = clk->round_rate(clk, rate);
|
|
|
else
|
|
|
rate = clk->get_rate(clk);
|
|
|
|
|
|
- clk_unlock();
|
|
|
-
|
|
|
return rate;
|
|
|
}
|
|
|
EXPORT_SYMBOL(clk_round_rate);
|
|
@@ -1111,10 +1091,10 @@ static struct clk_lookup lookups[] = {
|
|
|
_REGISTER_CLOCK("lpc32xx_keys.0", NULL, clk_kscan)
|
|
|
_REGISTER_CLOCK("lpc32xx-nand.0", "nand_ck", clk_nand)
|
|
|
_REGISTER_CLOCK("lpc32xx-adc", NULL, clk_adc)
|
|
|
- _REGISTER_CLOCK("tbd", "i2s0_ck", clk_i2s0)
|
|
|
- _REGISTER_CLOCK("tbd", "i2s1_ck", clk_i2s1)
|
|
|
+ _REGISTER_CLOCK(NULL, "i2s0_ck", clk_i2s0)
|
|
|
+ _REGISTER_CLOCK(NULL, "i2s1_ck", clk_i2s1)
|
|
|
_REGISTER_CLOCK("ts-lpc32xx", NULL, clk_tsc)
|
|
|
- _REGISTER_CLOCK("dev:mmc0", "MCLK", clk_mmc)
|
|
|
+ _REGISTER_CLOCK("dev:mmc0", NULL, clk_mmc)
|
|
|
_REGISTER_CLOCK("lpc-net.0", NULL, clk_net)
|
|
|
_REGISTER_CLOCK("dev:clcd", NULL, clk_lcd)
|
|
|
_REGISTER_CLOCK("lpc32xx_udc", "ck_usbd", clk_usbd)
|