caf64f2fdc
This will allow us to share the code between system timer and dmtimer device driver code without having to initialize all the dmtimers early. This change will also make the timer_set_next_event more efficient as the inline functions will optimize the code better for the timer reprogramming. Signed-off-by: Tony Lindgren <tony@atomide.com> Reviewed-by: Kevin Hilman <khilman@ti.com>
633 lines
17 KiB
C
633 lines
17 KiB
C
/*
|
|
* linux/arch/arm/plat-omap/dmtimer.c
|
|
*
|
|
* OMAP Dual-Mode Timers
|
|
*
|
|
* Copyright (C) 2005 Nokia Corporation
|
|
* OMAP2 support by Juha Yrjola
|
|
* API improvements and OMAP2 clock framework support by Timo Teras
|
|
*
|
|
* Copyright (C) 2009 Texas Instruments
|
|
* Added OMAP4 support - Santosh Shilimkar <santosh.shilimkar@ti.com>
|
|
*
|
|
* 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.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
|
|
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
|
|
* NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
* ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along
|
|
* with this program; if not, write to the Free Software Foundation, Inc.,
|
|
* 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*/
|
|
|
|
#include <linux/init.h>
|
|
#include <linux/spinlock.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/list.h>
|
|
#include <linux/clk.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/io.h>
|
|
#include <linux/module.h>
|
|
#include <mach/hardware.h>
|
|
#include <plat/dmtimer.h>
|
|
#include <mach/irqs.h>
|
|
|
|
static int dm_timer_count;
|
|
|
|
#ifdef CONFIG_ARCH_OMAP1
|
|
static struct omap_dm_timer omap1_dm_timers[] = {
|
|
{ .phys_base = 0xfffb1400, .irq = INT_1610_GPTIMER1 },
|
|
{ .phys_base = 0xfffb1c00, .irq = INT_1610_GPTIMER2 },
|
|
{ .phys_base = 0xfffb2400, .irq = INT_1610_GPTIMER3 },
|
|
{ .phys_base = 0xfffb2c00, .irq = INT_1610_GPTIMER4 },
|
|
{ .phys_base = 0xfffb3400, .irq = INT_1610_GPTIMER5 },
|
|
{ .phys_base = 0xfffb3c00, .irq = INT_1610_GPTIMER6 },
|
|
{ .phys_base = 0xfffb7400, .irq = INT_1610_GPTIMER7 },
|
|
{ .phys_base = 0xfffbd400, .irq = INT_1610_GPTIMER8 },
|
|
};
|
|
|
|
static const int omap1_dm_timer_count = ARRAY_SIZE(omap1_dm_timers);
|
|
|
|
#else
|
|
#define omap1_dm_timers NULL
|
|
#define omap1_dm_timer_count 0
|
|
#endif /* CONFIG_ARCH_OMAP1 */
|
|
|
|
#ifdef CONFIG_ARCH_OMAP2
|
|
static struct omap_dm_timer omap2_dm_timers[] = {
|
|
{ .phys_base = 0x48028000, .irq = INT_24XX_GPTIMER1 },
|
|
{ .phys_base = 0x4802a000, .irq = INT_24XX_GPTIMER2 },
|
|
{ .phys_base = 0x48078000, .irq = INT_24XX_GPTIMER3 },
|
|
{ .phys_base = 0x4807a000, .irq = INT_24XX_GPTIMER4 },
|
|
{ .phys_base = 0x4807c000, .irq = INT_24XX_GPTIMER5 },
|
|
{ .phys_base = 0x4807e000, .irq = INT_24XX_GPTIMER6 },
|
|
{ .phys_base = 0x48080000, .irq = INT_24XX_GPTIMER7 },
|
|
{ .phys_base = 0x48082000, .irq = INT_24XX_GPTIMER8 },
|
|
{ .phys_base = 0x48084000, .irq = INT_24XX_GPTIMER9 },
|
|
{ .phys_base = 0x48086000, .irq = INT_24XX_GPTIMER10 },
|
|
{ .phys_base = 0x48088000, .irq = INT_24XX_GPTIMER11 },
|
|
{ .phys_base = 0x4808a000, .irq = INT_24XX_GPTIMER12 },
|
|
};
|
|
|
|
static const char *omap2_dm_source_names[] __initdata = {
|
|
"sys_ck",
|
|
"func_32k_ck",
|
|
"alt_ck",
|
|
NULL
|
|
};
|
|
|
|
static struct clk *omap2_dm_source_clocks[3];
|
|
static const int omap2_dm_timer_count = ARRAY_SIZE(omap2_dm_timers);
|
|
|
|
#else
|
|
#define omap2_dm_timers NULL
|
|
#define omap2_dm_timer_count 0
|
|
#define omap2_dm_source_names NULL
|
|
#define omap2_dm_source_clocks NULL
|
|
#endif /* CONFIG_ARCH_OMAP2 */
|
|
|
|
#ifdef CONFIG_ARCH_OMAP3
|
|
static struct omap_dm_timer omap3_dm_timers[] = {
|
|
{ .phys_base = 0x48318000, .irq = INT_24XX_GPTIMER1 },
|
|
{ .phys_base = 0x49032000, .irq = INT_24XX_GPTIMER2 },
|
|
{ .phys_base = 0x49034000, .irq = INT_24XX_GPTIMER3 },
|
|
{ .phys_base = 0x49036000, .irq = INT_24XX_GPTIMER4 },
|
|
{ .phys_base = 0x49038000, .irq = INT_24XX_GPTIMER5 },
|
|
{ .phys_base = 0x4903A000, .irq = INT_24XX_GPTIMER6 },
|
|
{ .phys_base = 0x4903C000, .irq = INT_24XX_GPTIMER7 },
|
|
{ .phys_base = 0x4903E000, .irq = INT_24XX_GPTIMER8 },
|
|
{ .phys_base = 0x49040000, .irq = INT_24XX_GPTIMER9 },
|
|
{ .phys_base = 0x48086000, .irq = INT_24XX_GPTIMER10 },
|
|
{ .phys_base = 0x48088000, .irq = INT_24XX_GPTIMER11 },
|
|
{ .phys_base = 0x48304000, .irq = INT_34XX_GPT12_IRQ },
|
|
};
|
|
|
|
static const char *omap3_dm_source_names[] __initdata = {
|
|
"sys_ck",
|
|
"omap_32k_fck",
|
|
NULL
|
|
};
|
|
|
|
static struct clk *omap3_dm_source_clocks[2];
|
|
static const int omap3_dm_timer_count = ARRAY_SIZE(omap3_dm_timers);
|
|
|
|
#else
|
|
#define omap3_dm_timers NULL
|
|
#define omap3_dm_timer_count 0
|
|
#define omap3_dm_source_names NULL
|
|
#define omap3_dm_source_clocks NULL
|
|
#endif /* CONFIG_ARCH_OMAP3 */
|
|
|
|
#ifdef CONFIG_ARCH_OMAP4
|
|
static struct omap_dm_timer omap4_dm_timers[] = {
|
|
{ .phys_base = 0x4a318000, .irq = OMAP44XX_IRQ_GPT1 },
|
|
{ .phys_base = 0x48032000, .irq = OMAP44XX_IRQ_GPT2 },
|
|
{ .phys_base = 0x48034000, .irq = OMAP44XX_IRQ_GPT3 },
|
|
{ .phys_base = 0x48036000, .irq = OMAP44XX_IRQ_GPT4 },
|
|
{ .phys_base = 0x40138000, .irq = OMAP44XX_IRQ_GPT5 },
|
|
{ .phys_base = 0x4013a000, .irq = OMAP44XX_IRQ_GPT6 },
|
|
{ .phys_base = 0x4013a000, .irq = OMAP44XX_IRQ_GPT7 },
|
|
{ .phys_base = 0x4013e000, .irq = OMAP44XX_IRQ_GPT8 },
|
|
{ .phys_base = 0x4803e000, .irq = OMAP44XX_IRQ_GPT9 },
|
|
{ .phys_base = 0x48086000, .irq = OMAP44XX_IRQ_GPT10 },
|
|
{ .phys_base = 0x48088000, .irq = OMAP44XX_IRQ_GPT11 },
|
|
{ .phys_base = 0x4a320000, .irq = OMAP44XX_IRQ_GPT12 },
|
|
};
|
|
static const char *omap4_dm_source_names[] __initdata = {
|
|
"sys_clkin_ck",
|
|
"sys_32k_ck",
|
|
NULL
|
|
};
|
|
static struct clk *omap4_dm_source_clocks[2];
|
|
static const int omap4_dm_timer_count = ARRAY_SIZE(omap4_dm_timers);
|
|
|
|
#else
|
|
#define omap4_dm_timers NULL
|
|
#define omap4_dm_timer_count 0
|
|
#define omap4_dm_source_names NULL
|
|
#define omap4_dm_source_clocks NULL
|
|
#endif /* CONFIG_ARCH_OMAP4 */
|
|
|
|
static struct omap_dm_timer *dm_timers;
|
|
static const char **dm_source_names;
|
|
static struct clk **dm_source_clocks;
|
|
|
|
static spinlock_t dm_timer_lock;
|
|
|
|
/*
|
|
* Reads timer registers in posted and non-posted mode. The posted mode bit
|
|
* is encoded in reg. Note that in posted mode write pending bit must be
|
|
* checked. Otherwise a read of a non completed write will produce an error.
|
|
*/
|
|
static inline u32 omap_dm_timer_read_reg(struct omap_dm_timer *timer, u32 reg)
|
|
{
|
|
return __omap_dm_timer_read(timer->io_base, reg, timer->posted);
|
|
}
|
|
|
|
/*
|
|
* Writes timer registers in posted and non-posted mode. The posted mode bit
|
|
* is encoded in reg. Note that in posted mode the write pending bit must be
|
|
* checked. Otherwise a write on a register which has a pending write will be
|
|
* lost.
|
|
*/
|
|
static void omap_dm_timer_write_reg(struct omap_dm_timer *timer, u32 reg,
|
|
u32 value)
|
|
{
|
|
__omap_dm_timer_write(timer->io_base, reg, value, timer->posted);
|
|
}
|
|
|
|
static void omap_dm_timer_wait_for_reset(struct omap_dm_timer *timer)
|
|
{
|
|
int c;
|
|
|
|
c = 0;
|
|
while (!(omap_dm_timer_read_reg(timer, OMAP_TIMER_SYS_STAT_REG) & 1)) {
|
|
c++;
|
|
if (c > 100000) {
|
|
printk(KERN_ERR "Timer failed to reset\n");
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
|
|
static void omap_dm_timer_reset(struct omap_dm_timer *timer)
|
|
{
|
|
int autoidle = 0, wakeup = 0;
|
|
|
|
if (!cpu_class_is_omap2() || timer != &dm_timers[0]) {
|
|
omap_dm_timer_write_reg(timer, OMAP_TIMER_IF_CTRL_REG, 0x06);
|
|
omap_dm_timer_wait_for_reset(timer);
|
|
}
|
|
omap_dm_timer_set_source(timer, OMAP_TIMER_SRC_32_KHZ);
|
|
|
|
/* Enable autoidle on OMAP2 / OMAP3 */
|
|
if (cpu_is_omap24xx() || cpu_is_omap34xx())
|
|
autoidle = 1;
|
|
|
|
/*
|
|
* Enable wake-up on OMAP2 CPUs.
|
|
*/
|
|
if (cpu_class_is_omap2())
|
|
wakeup = 1;
|
|
|
|
__omap_dm_timer_reset(timer->io_base, autoidle, wakeup);
|
|
timer->posted = 1;
|
|
}
|
|
|
|
void omap_dm_timer_prepare(struct omap_dm_timer *timer)
|
|
{
|
|
omap_dm_timer_enable(timer);
|
|
omap_dm_timer_reset(timer);
|
|
}
|
|
|
|
struct omap_dm_timer *omap_dm_timer_request(void)
|
|
{
|
|
struct omap_dm_timer *timer = NULL;
|
|
unsigned long flags;
|
|
int i;
|
|
|
|
spin_lock_irqsave(&dm_timer_lock, flags);
|
|
for (i = 0; i < dm_timer_count; i++) {
|
|
if (dm_timers[i].reserved)
|
|
continue;
|
|
|
|
timer = &dm_timers[i];
|
|
timer->reserved = 1;
|
|
break;
|
|
}
|
|
spin_unlock_irqrestore(&dm_timer_lock, flags);
|
|
|
|
if (timer != NULL)
|
|
omap_dm_timer_prepare(timer);
|
|
|
|
return timer;
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_request);
|
|
|
|
struct omap_dm_timer *omap_dm_timer_request_specific(int id)
|
|
{
|
|
struct omap_dm_timer *timer;
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&dm_timer_lock, flags);
|
|
if (id <= 0 || id > dm_timer_count || dm_timers[id-1].reserved) {
|
|
spin_unlock_irqrestore(&dm_timer_lock, flags);
|
|
printk("BUG: warning at %s:%d/%s(): unable to get timer %d\n",
|
|
__FILE__, __LINE__, __func__, id);
|
|
dump_stack();
|
|
return NULL;
|
|
}
|
|
|
|
timer = &dm_timers[id-1];
|
|
timer->reserved = 1;
|
|
spin_unlock_irqrestore(&dm_timer_lock, flags);
|
|
|
|
omap_dm_timer_prepare(timer);
|
|
|
|
return timer;
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_request_specific);
|
|
|
|
void omap_dm_timer_free(struct omap_dm_timer *timer)
|
|
{
|
|
omap_dm_timer_enable(timer);
|
|
omap_dm_timer_reset(timer);
|
|
omap_dm_timer_disable(timer);
|
|
|
|
WARN_ON(!timer->reserved);
|
|
timer->reserved = 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_free);
|
|
|
|
void omap_dm_timer_enable(struct omap_dm_timer *timer)
|
|
{
|
|
if (timer->enabled)
|
|
return;
|
|
|
|
#ifdef CONFIG_ARCH_OMAP2PLUS
|
|
if (cpu_class_is_omap2()) {
|
|
clk_enable(timer->fclk);
|
|
clk_enable(timer->iclk);
|
|
}
|
|
#endif
|
|
|
|
timer->enabled = 1;
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_enable);
|
|
|
|
void omap_dm_timer_disable(struct omap_dm_timer *timer)
|
|
{
|
|
if (!timer->enabled)
|
|
return;
|
|
|
|
#ifdef CONFIG_ARCH_OMAP2PLUS
|
|
if (cpu_class_is_omap2()) {
|
|
clk_disable(timer->iclk);
|
|
clk_disable(timer->fclk);
|
|
}
|
|
#endif
|
|
|
|
timer->enabled = 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_disable);
|
|
|
|
int omap_dm_timer_get_irq(struct omap_dm_timer *timer)
|
|
{
|
|
return timer->irq;
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_get_irq);
|
|
|
|
#if defined(CONFIG_ARCH_OMAP1)
|
|
|
|
/**
|
|
* omap_dm_timer_modify_idlect_mask - Check if any running timers use ARMXOR
|
|
* @inputmask: current value of idlect mask
|
|
*/
|
|
__u32 omap_dm_timer_modify_idlect_mask(__u32 inputmask)
|
|
{
|
|
int i;
|
|
|
|
/* If ARMXOR cannot be idled this function call is unnecessary */
|
|
if (!(inputmask & (1 << 1)))
|
|
return inputmask;
|
|
|
|
/* If any active timer is using ARMXOR return modified mask */
|
|
for (i = 0; i < dm_timer_count; i++) {
|
|
u32 l;
|
|
|
|
l = omap_dm_timer_read_reg(&dm_timers[i], OMAP_TIMER_CTRL_REG);
|
|
if (l & OMAP_TIMER_CTRL_ST) {
|
|
if (((omap_readl(MOD_CONF_CTRL_1) >> (i * 2)) & 0x03) == 0)
|
|
inputmask &= ~(1 << 1);
|
|
else
|
|
inputmask &= ~(1 << 2);
|
|
}
|
|
}
|
|
|
|
return inputmask;
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_modify_idlect_mask);
|
|
|
|
#else
|
|
|
|
struct clk *omap_dm_timer_get_fclk(struct omap_dm_timer *timer)
|
|
{
|
|
return timer->fclk;
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_get_fclk);
|
|
|
|
__u32 omap_dm_timer_modify_idlect_mask(__u32 inputmask)
|
|
{
|
|
BUG();
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_modify_idlect_mask);
|
|
|
|
#endif
|
|
|
|
void omap_dm_timer_trigger(struct omap_dm_timer *timer)
|
|
{
|
|
omap_dm_timer_write_reg(timer, OMAP_TIMER_TRIGGER_REG, 0);
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_trigger);
|
|
|
|
void omap_dm_timer_start(struct omap_dm_timer *timer)
|
|
{
|
|
u32 l;
|
|
|
|
l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
|
|
if (!(l & OMAP_TIMER_CTRL_ST)) {
|
|
l |= OMAP_TIMER_CTRL_ST;
|
|
omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_start);
|
|
|
|
void omap_dm_timer_stop(struct omap_dm_timer *timer)
|
|
{
|
|
unsigned long rate = 0;
|
|
|
|
#ifdef CONFIG_ARCH_OMAP2PLUS
|
|
rate = clk_get_rate(timer->fclk);
|
|
#endif
|
|
|
|
__omap_dm_timer_stop(timer->io_base, timer->posted, rate);
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_stop);
|
|
|
|
#ifdef CONFIG_ARCH_OMAP1
|
|
|
|
int omap_dm_timer_set_source(struct omap_dm_timer *timer, int source)
|
|
{
|
|
int n = (timer - dm_timers) << 1;
|
|
u32 l;
|
|
|
|
l = omap_readl(MOD_CONF_CTRL_1) & ~(0x03 << n);
|
|
l |= source << n;
|
|
omap_writel(l, MOD_CONF_CTRL_1);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_set_source);
|
|
|
|
#else
|
|
|
|
int omap_dm_timer_set_source(struct omap_dm_timer *timer, int source)
|
|
{
|
|
if (source < 0 || source >= 3)
|
|
return -EINVAL;
|
|
|
|
return __omap_dm_timer_set_source(timer->fclk,
|
|
dm_source_clocks[source]);
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_set_source);
|
|
|
|
#endif
|
|
|
|
void omap_dm_timer_set_load(struct omap_dm_timer *timer, int autoreload,
|
|
unsigned int load)
|
|
{
|
|
u32 l;
|
|
|
|
l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
|
|
if (autoreload)
|
|
l |= OMAP_TIMER_CTRL_AR;
|
|
else
|
|
l &= ~OMAP_TIMER_CTRL_AR;
|
|
omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
|
|
omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG, load);
|
|
|
|
omap_dm_timer_write_reg(timer, OMAP_TIMER_TRIGGER_REG, 0);
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_set_load);
|
|
|
|
/* Optimized set_load which removes costly spin wait in timer_start */
|
|
void omap_dm_timer_set_load_start(struct omap_dm_timer *timer, int autoreload,
|
|
unsigned int load)
|
|
{
|
|
u32 l;
|
|
|
|
l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
|
|
if (autoreload) {
|
|
l |= OMAP_TIMER_CTRL_AR;
|
|
omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG, load);
|
|
} else {
|
|
l &= ~OMAP_TIMER_CTRL_AR;
|
|
}
|
|
l |= OMAP_TIMER_CTRL_ST;
|
|
|
|
__omap_dm_timer_load_start(timer->io_base, l, load, timer->posted);
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_set_load_start);
|
|
|
|
void omap_dm_timer_set_match(struct omap_dm_timer *timer, int enable,
|
|
unsigned int match)
|
|
{
|
|
u32 l;
|
|
|
|
l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
|
|
if (enable)
|
|
l |= OMAP_TIMER_CTRL_CE;
|
|
else
|
|
l &= ~OMAP_TIMER_CTRL_CE;
|
|
omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
|
|
omap_dm_timer_write_reg(timer, OMAP_TIMER_MATCH_REG, match);
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_set_match);
|
|
|
|
void omap_dm_timer_set_pwm(struct omap_dm_timer *timer, int def_on,
|
|
int toggle, int trigger)
|
|
{
|
|
u32 l;
|
|
|
|
l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
|
|
l &= ~(OMAP_TIMER_CTRL_GPOCFG | OMAP_TIMER_CTRL_SCPWM |
|
|
OMAP_TIMER_CTRL_PT | (0x03 << 10));
|
|
if (def_on)
|
|
l |= OMAP_TIMER_CTRL_SCPWM;
|
|
if (toggle)
|
|
l |= OMAP_TIMER_CTRL_PT;
|
|
l |= trigger << 10;
|
|
omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_set_pwm);
|
|
|
|
void omap_dm_timer_set_prescaler(struct omap_dm_timer *timer, int prescaler)
|
|
{
|
|
u32 l;
|
|
|
|
l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
|
|
l &= ~(OMAP_TIMER_CTRL_PRE | (0x07 << 2));
|
|
if (prescaler >= 0x00 && prescaler <= 0x07) {
|
|
l |= OMAP_TIMER_CTRL_PRE;
|
|
l |= prescaler << 2;
|
|
}
|
|
omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_set_prescaler);
|
|
|
|
void omap_dm_timer_set_int_enable(struct omap_dm_timer *timer,
|
|
unsigned int value)
|
|
{
|
|
__omap_dm_timer_int_enable(timer->io_base, value);
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_set_int_enable);
|
|
|
|
unsigned int omap_dm_timer_read_status(struct omap_dm_timer *timer)
|
|
{
|
|
unsigned int l;
|
|
|
|
l = omap_dm_timer_read_reg(timer, OMAP_TIMER_STAT_REG);
|
|
|
|
return l;
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_read_status);
|
|
|
|
void omap_dm_timer_write_status(struct omap_dm_timer *timer, unsigned int value)
|
|
{
|
|
__omap_dm_timer_write_status(timer->io_base, value);
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_write_status);
|
|
|
|
unsigned int omap_dm_timer_read_counter(struct omap_dm_timer *timer)
|
|
{
|
|
return __omap_dm_timer_read_counter(timer->io_base, timer->posted);
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_read_counter);
|
|
|
|
void omap_dm_timer_write_counter(struct omap_dm_timer *timer, unsigned int value)
|
|
{
|
|
omap_dm_timer_write_reg(timer, OMAP_TIMER_COUNTER_REG, value);
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timer_write_counter);
|
|
|
|
int omap_dm_timers_active(void)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < dm_timer_count; i++) {
|
|
struct omap_dm_timer *timer;
|
|
|
|
timer = &dm_timers[i];
|
|
|
|
if (!timer->enabled)
|
|
continue;
|
|
|
|
if (omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG) &
|
|
OMAP_TIMER_CTRL_ST) {
|
|
return 1;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(omap_dm_timers_active);
|
|
|
|
int __init omap_dm_timer_init(void)
|
|
{
|
|
struct omap_dm_timer *timer;
|
|
int i, map_size = SZ_8K; /* Module 4KB + L4 4KB except on omap1 */
|
|
|
|
if (!(cpu_is_omap16xx() || cpu_class_is_omap2()))
|
|
return -ENODEV;
|
|
|
|
spin_lock_init(&dm_timer_lock);
|
|
|
|
if (cpu_class_is_omap1()) {
|
|
dm_timers = omap1_dm_timers;
|
|
dm_timer_count = omap1_dm_timer_count;
|
|
map_size = SZ_2K;
|
|
} else if (cpu_is_omap24xx()) {
|
|
dm_timers = omap2_dm_timers;
|
|
dm_timer_count = omap2_dm_timer_count;
|
|
dm_source_names = omap2_dm_source_names;
|
|
dm_source_clocks = omap2_dm_source_clocks;
|
|
} else if (cpu_is_omap34xx()) {
|
|
dm_timers = omap3_dm_timers;
|
|
dm_timer_count = omap3_dm_timer_count;
|
|
dm_source_names = omap3_dm_source_names;
|
|
dm_source_clocks = omap3_dm_source_clocks;
|
|
} else if (cpu_is_omap44xx()) {
|
|
dm_timers = omap4_dm_timers;
|
|
dm_timer_count = omap4_dm_timer_count;
|
|
dm_source_names = omap4_dm_source_names;
|
|
dm_source_clocks = omap4_dm_source_clocks;
|
|
}
|
|
|
|
if (cpu_class_is_omap2())
|
|
for (i = 0; dm_source_names[i] != NULL; i++)
|
|
dm_source_clocks[i] = clk_get(NULL, dm_source_names[i]);
|
|
|
|
if (cpu_is_omap243x())
|
|
dm_timers[0].phys_base = 0x49018000;
|
|
|
|
for (i = 0; i < dm_timer_count; i++) {
|
|
timer = &dm_timers[i];
|
|
|
|
/* Static mapping, never released */
|
|
timer->io_base = ioremap(timer->phys_base, map_size);
|
|
BUG_ON(!timer->io_base);
|
|
|
|
#ifdef CONFIG_ARCH_OMAP2PLUS
|
|
if (cpu_class_is_omap2()) {
|
|
char clk_name[16];
|
|
sprintf(clk_name, "gpt%d_ick", i + 1);
|
|
timer->iclk = clk_get(NULL, clk_name);
|
|
sprintf(clk_name, "gpt%d_fck", i + 1);
|
|
timer->fclk = clk_get(NULL, clk_name);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
return 0;
|
|
}
|