1 /*
2 * This program is free software; you can redistribute it and/or modify it
3 * under the terms of the GNU General Public License version 2 as published
4 * by the Free Software Foundation.
5 *
6 * Copyright (C) 2011 Gabor Juhos <juhosg@openwrt.org>
7 * Copyright (C) 2013 John Crispin <john@phrozen.org>
8 */
9
10 #include <linux/kernel.h>
11 #include <linux/init.h>
12 #include <linux/export.h>
13 #include <linux/clkdev.h>
14 #include <linux/clk.h>
15
16 #include <asm/time.h>
17
18 #include "common.h"
19
20 struct clk {
21 struct clk_lookup cl;
22 unsigned long rate;
23 };
24
ralink_clk_add(const char * dev,unsigned long rate)25 void ralink_clk_add(const char *dev, unsigned long rate)
26 {
27 struct clk *clk = kzalloc(sizeof(struct clk), GFP_KERNEL);
28
29 if (!clk)
30 panic("failed to add clock");
31
32 clk->cl.dev_id = dev;
33 clk->cl.clk = clk;
34
35 clk->rate = rate;
36
37 clkdev_add(&clk->cl);
38 }
39
40 /*
41 * Linux clock API
42 */
clk_enable(struct clk * clk)43 int clk_enable(struct clk *clk)
44 {
45 return 0;
46 }
47 EXPORT_SYMBOL_GPL(clk_enable);
48
clk_disable(struct clk * clk)49 void clk_disable(struct clk *clk)
50 {
51 }
52 EXPORT_SYMBOL_GPL(clk_disable);
53
clk_get_rate(struct clk * clk)54 unsigned long clk_get_rate(struct clk *clk)
55 {
56 if (!clk)
57 return 0;
58
59 return clk->rate;
60 }
61 EXPORT_SYMBOL_GPL(clk_get_rate);
62
clk_set_rate(struct clk * clk,unsigned long rate)63 int clk_set_rate(struct clk *clk, unsigned long rate)
64 {
65 return -1;
66 }
67 EXPORT_SYMBOL_GPL(clk_set_rate);
68
clk_round_rate(struct clk * clk,unsigned long rate)69 long clk_round_rate(struct clk *clk, unsigned long rate)
70 {
71 return -1;
72 }
73 EXPORT_SYMBOL_GPL(clk_round_rate);
74
plat_time_init(void)75 void __init plat_time_init(void)
76 {
77 struct clk *clk;
78
79 ralink_of_remap();
80
81 ralink_clk_init();
82 clk = clk_get_sys("cpu", NULL);
83 if (IS_ERR(clk))
84 panic("unable to get CPU clock, err=%ld", PTR_ERR(clk));
85 pr_info("CPU Clock: %ldMHz\n", clk_get_rate(clk) / 1000000);
86 mips_hpt_frequency = clk_get_rate(clk) / 2;
87 clk_put(clk);
88 timer_probe();
89 }
90
