1/******************************************************************************* 2 STMMAC external timer support. 3 4 Copyright (C) 2007-2009 STMicroelectronics Ltd 5 6 This program is free software; you can redistribute it and/or modify it 7 under the terms and conditions of the GNU General Public License, 8 version 2, as published by the Free Software Foundation. 9 10 This program is distributed in the hope it will be useful, but WITHOUT 11 ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 12 FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 13 more details. 14 15 You should have received a copy of the GNU General Public License along with 16 this program; if not, write to the Free Software Foundation, Inc., 17 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. 18 19 The full GNU General Public License is included in this distribution in 20 the file called "COPYING". 21 22 Author: Giuseppe Cavallaro <peppe.cavallaro@st.com> 23*******************************************************************************/ 24 25#include <linux/kernel.h> 26#include <linux/etherdevice.h> 27#include "stmmac_timer.h" 28 29static void stmmac_timer_handler(void *data) 30{ 31 struct net_device *dev = (struct net_device *)data; 32 33 stmmac_schedule(dev); 34} 35 36#define STMMAC_TIMER_MSG(timer, freq) \ 37printk(KERN_INFO "stmmac_timer: %s Timer ON (freq %dHz)\n", timer, freq); 38 39#if defined(CONFIG_STMMAC_RTC_TIMER) 40#include <linux/rtc.h> 41static struct rtc_device *stmmac_rtc; 42static rtc_task_t stmmac_task; 43 44static void stmmac_rtc_start(unsigned int new_freq) 45{ 46 rtc_irq_set_freq(stmmac_rtc, &stmmac_task, new_freq); 47 rtc_irq_set_state(stmmac_rtc, &stmmac_task, 1); 48} 49 50static void stmmac_rtc_stop(void) 51{ 52 rtc_irq_set_state(stmmac_rtc, &stmmac_task, 0); 53} 54 55int stmmac_open_ext_timer(struct net_device *dev, struct stmmac_timer *tm) 56{ 57 stmmac_task.private_data = dev; 58 stmmac_task.func = stmmac_timer_handler; 59 60 stmmac_rtc = rtc_class_open(CONFIG_RTC_HCTOSYS_DEVICE); 61 if (stmmac_rtc == NULL) { 62 pr_err("open rtc device failed\n"); 63 return -ENODEV; 64 } 65 66 rtc_irq_register(stmmac_rtc, &stmmac_task); 67 68 /* Periodic mode is not supported */ 69 if ((rtc_irq_set_freq(stmmac_rtc, &stmmac_task, tm->freq) < 0)) { 70 pr_err("set periodic failed\n"); 71 rtc_irq_unregister(stmmac_rtc, &stmmac_task); 72 rtc_class_close(stmmac_rtc); 73 return -1; 74 } 75 76 STMMAC_TIMER_MSG(CONFIG_RTC_HCTOSYS_DEVICE, tm->freq); 77 78 tm->timer_start = stmmac_rtc_start; 79 tm->timer_stop = stmmac_rtc_stop; 80 81 return 0; 82} 83 84int stmmac_close_ext_timer(void) 85{ 86 rtc_irq_set_state(stmmac_rtc, &stmmac_task, 0); 87 rtc_irq_unregister(stmmac_rtc, &stmmac_task); 88 rtc_class_close(stmmac_rtc); 89 return 0; 90} 91 92#elif defined(CONFIG_STMMAC_TMU_TIMER) 93#include <linux/clk.h> 94#define TMU_CHANNEL "tmu2_clk" 95static struct clk *timer_clock; 96 97static void stmmac_tmu_start(unsigned int new_freq) 98{ 99 clk_set_rate(timer_clock, new_freq); 100 clk_enable(timer_clock); 101} 102 103static void stmmac_tmu_stop(void) 104{ 105 clk_disable(timer_clock); 106} 107 108int stmmac_open_ext_timer(struct net_device *dev, struct stmmac_timer *tm) 109{ 110 timer_clock = clk_get(NULL, TMU_CHANNEL); 111 112 if (timer_clock == NULL) 113 return -1; 114 115 if (tmu2_register_user(stmmac_timer_handler, (void *)dev) < 0) { 116 timer_clock = NULL; 117 return -1; 118 } 119 120 STMMAC_TIMER_MSG("TMU2", tm->freq); 121 tm->timer_start = stmmac_tmu_start; 122 tm->timer_stop = stmmac_tmu_stop; 123 124 return 0; 125} 126 127int stmmac_close_ext_timer(void) 128{ 129 clk_disable(timer_clock); 130 tmu2_unregister_user(); 131 clk_put(timer_clock); 132 return 0; 133} 134#endif 135