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 <blogic@openwrt.org> 8 */ 9 10 #include <linux/kernel.h> 11 #include <linux/module.h> 12 #include <linux/clkdev.h> 13 #include <linux/clk.h> 14 15 #include <asm/time.h> 16 17 #include "common.h" 18 19 struct clk { 20 struct clk_lookup cl; 21 unsigned long rate; 22 }; 23 24 void ralink_clk_add(const char *dev, unsigned long rate) 25 { 26 struct clk *clk = kzalloc(sizeof(struct clk), GFP_KERNEL); 27 28 if (!clk) 29 panic("failed to add clock"); 30 31 clk->cl.dev_id = dev; 32 clk->cl.clk = clk; 33 34 clk->rate = rate; 35 36 clkdev_add(&clk->cl); 37 } 38 39 /* 40 * Linux clock API 41 */ 42 int clk_enable(struct clk *clk) 43 { 44 return 0; 45 } 46 EXPORT_SYMBOL_GPL(clk_enable); 47 48 void clk_disable(struct clk *clk) 49 { 50 } 51 EXPORT_SYMBOL_GPL(clk_disable); 52 53 unsigned long clk_get_rate(struct clk *clk) 54 { 55 return clk->rate; 56 } 57 EXPORT_SYMBOL_GPL(clk_get_rate); 58 59 void __init plat_time_init(void) 60 { 61 struct clk *clk; 62 63 ralink_of_remap(); 64 65 ralink_clk_init(); 66 clk = clk_get_sys("cpu", NULL); 67 if (IS_ERR(clk)) 68 panic("unable to get CPU clock, err=%ld", PTR_ERR(clk)); 69 pr_info("CPU Clock: %ldMHz\n", clk_get_rate(clk) / 1000000); 70 mips_hpt_frequency = clk_get_rate(clk) / 2; 71 clk_put(clk); 72 clocksource_of_init(); 73 } 74