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 20struct clk { 21 struct clk_lookup cl; 22 unsigned long rate; 23}; 24 25void 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 */ 43int clk_enable(struct clk *clk) 44{ 45 return 0; 46} 47EXPORT_SYMBOL_GPL(clk_enable); 48 49void clk_disable(struct clk *clk) 50{ 51} 52EXPORT_SYMBOL_GPL(clk_disable); 53 54unsigned long clk_get_rate(struct clk *clk) 55{ 56 if (!clk) 57 return 0; 58 59 return clk->rate; 60} 61EXPORT_SYMBOL_GPL(clk_get_rate); 62 63int clk_set_rate(struct clk *clk, unsigned long rate) 64{ 65 return -1; 66} 67EXPORT_SYMBOL_GPL(clk_set_rate); 68 69long clk_round_rate(struct clk *clk, unsigned long rate) 70{ 71 return -1; 72} 73EXPORT_SYMBOL_GPL(clk_round_rate); 74 75void __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