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 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 */ 43 int clk_enable(struct clk *clk) 44 { 45 return 0; 46 } 47 EXPORT_SYMBOL_GPL(clk_enable); 48 49 void clk_disable(struct clk *clk) 50 { 51 } 52 EXPORT_SYMBOL_GPL(clk_disable); 53 54 unsigned long clk_get_rate(struct clk *clk) 55 { 56 return clk->rate; 57 } 58 EXPORT_SYMBOL_GPL(clk_get_rate); 59 60 int clk_set_rate(struct clk *clk, unsigned long rate) 61 { 62 return -1; 63 } 64 EXPORT_SYMBOL_GPL(clk_set_rate); 65 66 long clk_round_rate(struct clk *clk, unsigned long rate) 67 { 68 return -1; 69 } 70 EXPORT_SYMBOL_GPL(clk_round_rate); 71 72 void __init plat_time_init(void) 73 { 74 struct clk *clk; 75 76 ralink_of_remap(); 77 78 ralink_clk_init(); 79 clk = clk_get_sys("cpu", NULL); 80 if (IS_ERR(clk)) 81 panic("unable to get CPU clock, err=%ld", PTR_ERR(clk)); 82 pr_info("CPU Clock: %ldMHz\n", clk_get_rate(clk) / 1000000); 83 mips_hpt_frequency = clk_get_rate(clk) / 2; 84 clk_put(clk); 85 timer_probe(); 86 } 87