linux-imx

/*

 *  linux/drivers/clocksource/timer-sp.c

 *

 *  Copyright (C) 1999 - 2003 ARM Limited

 *  Copyright (C) 2000 Deep Blue Solutions Ltd

 *

 * 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 program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 *

 * 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., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

 */

#include <linux/clk.h>

#include <linux/clocksource.h>

#include <linux/clockchips.h>

#include <linux/err.h>

#include <linux/interrupt.h>

#include <linux/irq.h>

#include <linux/io.h>

#include <linux/of.h>

#include <linux/of_address.h>

#include <linux/of_clk.h>

#include <linux/of_irq.h>

#include <linux/sched_clock.h>

​

#include <clocksource/timer-sp804.h>

​

#include "timer-sp.h"

​

static long __init sp804_get_clock_rate(struct clk *clk)

{

    long rate;

    int err;

​

    err = clk_prepare(clk);

    if (err) {

        pr_err("sp804: clock failed to prepare: %d\n", err);

        clk_put(clk);

        return err;

    }

​

    err = clk_enable(clk);

    if (err) {

        pr_err("sp804: clock failed to enable: %d\n", err);

        clk_unprepare(clk);

        clk_put(clk);

        return err;

    }

​

    rate = clk_get_rate(clk);

    if (rate < 0) {

        pr_err("sp804: clock failed to get rate: %ld\n", rate);

        clk_disable(clk);

        clk_unprepare(clk);

        clk_put(clk);

    }

​

    return rate;

}

​

static void __iomem *sched_clock_base;

​

static u64 notrace sp804_read(void)

{

    return ~readl_relaxed(sched_clock_base + TIMER_VALUE);

}

​

void __init sp804_timer_disable(void __iomem *base)

{

    writel(0, base + TIMER_CTRL);

}

​

int  __init __sp804_clocksource_and_sched_clock_init(void __iomem *base,

                             const char *name,

                             struct clk *clk,

                             int use_sched_clock)

{

    long rate;

​

    if (!clk) {

        clk = clk_get_sys("sp804", name);

        if (IS_ERR(clk)) {

            pr_err("sp804: clock not found: %d\n",

                   (int)PTR_ERR(clk));