Release 4.14 arch/mips/lantiq/clk.c

/*
 *  This program is free software; you can redistribute it and/or modify it
 *  under the terms of the GNU General Public License version 2 as published
 *  by the Free Software Foundation.
 *
 * Copyright (C) 2010 Thomas Langer <thomas.langer@lantiq.com>
 * Copyright (C) 2010 John Crispin <john@phrozen.org>
 */
#include <linux/io.h>
#include <linux/export.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/types.h>
#include <linux/clk.h>
#include <linux/clkdev.h>
#include <linux/err.h>
#include <linux/list.h>

#include <asm/time.h>
#include <asm/irq.h>
#include <asm/div64.h>

#include <lantiq_soc.h>

#include "clk.h"
#include "prom.h"

/* lantiq socs have 3 static clocks */

static struct clk cpu_clk_generic[4];



void clkdev_add_static(unsigned long cpu, unsigned long fpi,
			unsigned long io, unsigned long ppe)
{
	cpu_clk_generic[0].rate = cpu;
	cpu_clk_generic[1].rate = fpi;
	cpu_clk_generic[2].rate = io;
	cpu_clk_generic[3].rate = ppe;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
57
100.00%
3
100.00%
Total
57
100.00%
3
100.00%



struct clk *clk_get_cpu(void)
{
	return &cpu_clk_generic[0];
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
16
100.00%
2
100.00%
Total
16
100.00%
2
100.00%



struct clk *clk_get_fpi(void)
{
	return &cpu_clk_generic[1];
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
16
100.00%
2
100.00%
Total
16
100.00%
2
100.00%


EXPORT_SYMBOL_GPL(clk_get_fpi);



struct clk *clk_get_io(void)
{
	return &cpu_clk_generic[2];
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
16
100.00%
2
100.00%
Total
16
100.00%
2
100.00%



struct clk *clk_get_ppe(void)
{
	return &cpu_clk_generic[3];
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
16
100.00%
1
100.00%
Total
16
100.00%
1
100.00%


EXPORT_SYMBOL_GPL(clk_get_ppe);



static inline int clk_good(struct clk *clk)
{
	return clk && !IS_ERR(clk);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
21
100.00%
1
100.00%
Total
21
100.00%
1
100.00%



unsigned long clk_get_rate(struct clk *clk)
{
	if (unlikely(!clk_good(clk)))
		return 0;

	if (clk->rate != 0)
		return clk->rate;

	if (clk->get_rate != NULL)
		return clk->get_rate();

	return 0;
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
55
100.00%
1
100.00%
Total
55
100.00%
1
100.00%


EXPORT_SYMBOL(clk_get_rate);



int clk_set_rate(struct clk *clk, unsigned long rate)
{
	if (unlikely(!clk_good(clk)))
		return 0;
	if (clk->rates && *clk->rates) {
		unsigned long *r = clk->rates;

		while (*r && (*r != rate))
			r++;
		if (!*r) {
			pr_err("clk %s.%s: trying to set invalid rate %ld\n",
				clk->cl.dev_id, clk->cl.con_id, rate);
			return -1;
		}
	}
	clk->rate = rate;
	return 0;
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
105
100.00%
2
100.00%
Total
105
100.00%
2
100.00%


EXPORT_SYMBOL(clk_set_rate);



long clk_round_rate(struct clk *clk, unsigned long rate)
{
	if (unlikely(!clk_good(clk)))
		return 0;
	if (clk->rates && *clk->rates) {
		unsigned long *r = clk->rates;

		while (*r && (*r != rate))
			r++;
		if (!*r) {
			return clk->rate;
		}
	}
	return rate;
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
Hauke Mehrtens
81
100.00%
1
100.00%
Total
81
100.00%
1
100.00%


EXPORT_SYMBOL(clk_round_rate);



int clk_enable(struct clk *clk)
{
	if (unlikely(!clk_good(clk)))
		return -1;

	if (clk->enable)
		return clk->enable(clk);

	return -1;
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
43
100.00%
2
100.00%
Total
43
100.00%
2
100.00%


EXPORT_SYMBOL(clk_enable);



void clk_disable(struct clk *clk)
{
	if (unlikely(!clk_good(clk)))
		return;

	if (clk->disable)
		clk->disable(clk);
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
35
100.00%
2
100.00%
Total
35
100.00%
2
100.00%


EXPORT_SYMBOL(clk_disable);



int clk_activate(struct clk *clk)
{
	if (unlikely(!clk_good(clk)))
		return -1;

	if (clk->activate)
		return clk->activate(clk);

	return -1;
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
43
100.00%
2
100.00%
Total
43
100.00%
2
100.00%


EXPORT_SYMBOL(clk_activate);



void clk_deactivate(struct clk *clk)
{
	if (unlikely(!clk_good(clk)))
		return;

	if (clk->deactivate)
		clk->deactivate(clk);
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
35
100.00%
2
100.00%
Total
35
100.00%
2
100.00%


EXPORT_SYMBOL(clk_deactivate);



static inline u32 get_counter_resolution(void)
{
	u32 res;

	__asm__ __volatile__(
                ".set   push\n"
                ".set   mips32r2\n"
                "rdhwr  %0, $3\n"
                ".set pop\n"
                : "=&r" (res)
                : /* no input */
		: "memory");

	return res;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
19
95.00%
2
66.67%
Ralf Bächle
1
5.00%
1
33.33%
Total
20
100.00%
3
100.00%



void __init plat_time_init(void)
{
	struct clk *clk;

	ltq_soc_init();

	clk = clk_get_cpu();
	mips_hpt_frequency = clk_get_rate(clk) / get_counter_resolution();
	write_c0_compare(read_c0_count());
	pr_info("CPU Clock: %ldMHz\n", clk_get_rate(clk) / 1000000);
	clk_put(clk);
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
54
100.00%
2
100.00%
Total
54
100.00%
2
100.00%

Overall Contributors
Person
Tokens
Prop
Commits
CommitProp
John Crispin
626
87.80%
6
75.00%
Hauke Mehrtens
86
12.06%
1
12.50%
Ralf Bächle
1
0.14%
1
12.50%
Total
713
100.00%
8
100.00%
Directory: arch/mips/lantiq

Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.