1*84ad6884SPeter Tyser /* 2*84ad6884SPeter Tyser * (C) Copyright 2009 3*84ad6884SPeter Tyser * Vipin Kumar, ST Micoelectronics, vipin.kumar@st.com. 4*84ad6884SPeter Tyser * 5*84ad6884SPeter Tyser * See file CREDITS for list of people who contributed to this 6*84ad6884SPeter Tyser * project. 7*84ad6884SPeter Tyser * 8*84ad6884SPeter Tyser * This program is free software; you can redistribute it and/or 9*84ad6884SPeter Tyser * modify it under the terms of the GNU General Public License as 10*84ad6884SPeter Tyser * published by the Free Software Foundation; either version 2 of 11*84ad6884SPeter Tyser * the License, or (at your option) any later version. 12*84ad6884SPeter Tyser * 13*84ad6884SPeter Tyser * This program is distributed in the hope that it will be useful, 14*84ad6884SPeter Tyser * but WITHOUT ANY WARRANTY; without even the implied warranty of 15*84ad6884SPeter Tyser * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16*84ad6884SPeter Tyser * GNU General Public License for more details. 17*84ad6884SPeter Tyser * 18*84ad6884SPeter Tyser * You should have received a copy of the GNU General Public License 19*84ad6884SPeter Tyser * along with this program; if not, write to the Free Software 20*84ad6884SPeter Tyser * Foundation, Inc., 59 Temple Place, Suite 330, Boston, 21*84ad6884SPeter Tyser * MA 02111-1307 USA 22*84ad6884SPeter Tyser */ 23*84ad6884SPeter Tyser 24*84ad6884SPeter Tyser #include <common.h> 25*84ad6884SPeter Tyser #include <asm/io.h> 26*84ad6884SPeter Tyser #include <asm/arch/hardware.h> 27*84ad6884SPeter Tyser #include <asm/arch/spr_gpt.h> 28*84ad6884SPeter Tyser #include <asm/arch/spr_misc.h> 29*84ad6884SPeter Tyser 30*84ad6884SPeter Tyser #define GPT_RESOLUTION (CONFIG_SPEAR_HZ_CLOCK / CONFIG_SPEAR_HZ) 31*84ad6884SPeter Tyser #define READ_TIMER() (readl(&gpt_regs_p->count) & GPT_FREE_RUNNING) 32*84ad6884SPeter Tyser 33*84ad6884SPeter Tyser static struct gpt_regs *const gpt_regs_p = 34*84ad6884SPeter Tyser (struct gpt_regs *)CONFIG_SPEAR_TIMERBASE; 35*84ad6884SPeter Tyser 36*84ad6884SPeter Tyser static struct misc_regs *const misc_regs_p = 37*84ad6884SPeter Tyser (struct misc_regs *)CONFIG_SPEAR_MISCBASE; 38*84ad6884SPeter Tyser 39*84ad6884SPeter Tyser static ulong timestamp; 40*84ad6884SPeter Tyser static ulong lastdec; 41*84ad6884SPeter Tyser 42*84ad6884SPeter Tyser int timer_init(void) 43*84ad6884SPeter Tyser { 44*84ad6884SPeter Tyser u32 synth; 45*84ad6884SPeter Tyser 46*84ad6884SPeter Tyser /* Prescaler setting */ 47*84ad6884SPeter Tyser #if defined(CONFIG_SPEAR3XX) 48*84ad6884SPeter Tyser writel(MISC_PRSC_CFG, &misc_regs_p->prsc2_clk_cfg); 49*84ad6884SPeter Tyser synth = MISC_GPT4SYNTH; 50*84ad6884SPeter Tyser #elif defined(CONFIG_SPEAR600) 51*84ad6884SPeter Tyser writel(MISC_PRSC_CFG, &misc_regs_p->prsc1_clk_cfg); 52*84ad6884SPeter Tyser synth = MISC_GPT3SYNTH; 53*84ad6884SPeter Tyser #else 54*84ad6884SPeter Tyser # error Incorrect config. Can only be spear{600|300|310|320} 55*84ad6884SPeter Tyser #endif 56*84ad6884SPeter Tyser 57*84ad6884SPeter Tyser writel(readl(&misc_regs_p->periph_clk_cfg) | synth, 58*84ad6884SPeter Tyser &misc_regs_p->periph_clk_cfg); 59*84ad6884SPeter Tyser 60*84ad6884SPeter Tyser /* disable timers */ 61*84ad6884SPeter Tyser writel(GPT_PRESCALER_1 | GPT_MODE_AUTO_RELOAD, &gpt_regs_p->control); 62*84ad6884SPeter Tyser 63*84ad6884SPeter Tyser /* load value for free running */ 64*84ad6884SPeter Tyser writel(GPT_FREE_RUNNING, &gpt_regs_p->compare); 65*84ad6884SPeter Tyser 66*84ad6884SPeter Tyser /* auto reload, start timer */ 67*84ad6884SPeter Tyser writel(readl(&gpt_regs_p->control) | GPT_ENABLE, &gpt_regs_p->control); 68*84ad6884SPeter Tyser 69*84ad6884SPeter Tyser reset_timer_masked(); 70*84ad6884SPeter Tyser 71*84ad6884SPeter Tyser return 0; 72*84ad6884SPeter Tyser } 73*84ad6884SPeter Tyser 74*84ad6884SPeter Tyser /* 75*84ad6884SPeter Tyser * timer without interrupts 76*84ad6884SPeter Tyser */ 77*84ad6884SPeter Tyser 78*84ad6884SPeter Tyser void reset_timer(void) 79*84ad6884SPeter Tyser { 80*84ad6884SPeter Tyser reset_timer_masked(); 81*84ad6884SPeter Tyser } 82*84ad6884SPeter Tyser 83*84ad6884SPeter Tyser ulong get_timer(ulong base) 84*84ad6884SPeter Tyser { 85*84ad6884SPeter Tyser return (get_timer_masked() / GPT_RESOLUTION) - base; 86*84ad6884SPeter Tyser } 87*84ad6884SPeter Tyser 88*84ad6884SPeter Tyser void set_timer(ulong t) 89*84ad6884SPeter Tyser { 90*84ad6884SPeter Tyser timestamp = t; 91*84ad6884SPeter Tyser } 92*84ad6884SPeter Tyser 93*84ad6884SPeter Tyser void __udelay(unsigned long usec) 94*84ad6884SPeter Tyser { 95*84ad6884SPeter Tyser ulong tmo; 96*84ad6884SPeter Tyser ulong start = get_timer_masked(); 97*84ad6884SPeter Tyser ulong tenudelcnt = CONFIG_SPEAR_HZ_CLOCK / (1000 * 100); 98*84ad6884SPeter Tyser ulong rndoff; 99*84ad6884SPeter Tyser 100*84ad6884SPeter Tyser rndoff = (usec % 10) ? 1 : 0; 101*84ad6884SPeter Tyser 102*84ad6884SPeter Tyser /* tenudelcnt timer tick gives 10 microsecconds delay */ 103*84ad6884SPeter Tyser tmo = ((usec / 10) + rndoff) * tenudelcnt; 104*84ad6884SPeter Tyser 105*84ad6884SPeter Tyser while ((ulong) (get_timer_masked() - start) < tmo) 106*84ad6884SPeter Tyser ; 107*84ad6884SPeter Tyser } 108*84ad6884SPeter Tyser 109*84ad6884SPeter Tyser void reset_timer_masked(void) 110*84ad6884SPeter Tyser { 111*84ad6884SPeter Tyser /* reset time */ 112*84ad6884SPeter Tyser lastdec = READ_TIMER(); 113*84ad6884SPeter Tyser timestamp = 0; 114*84ad6884SPeter Tyser } 115*84ad6884SPeter Tyser 116*84ad6884SPeter Tyser ulong get_timer_masked(void) 117*84ad6884SPeter Tyser { 118*84ad6884SPeter Tyser ulong now = READ_TIMER(); 119*84ad6884SPeter Tyser 120*84ad6884SPeter Tyser if (now >= lastdec) { 121*84ad6884SPeter Tyser /* normal mode */ 122*84ad6884SPeter Tyser timestamp += now - lastdec; 123*84ad6884SPeter Tyser } else { 124*84ad6884SPeter Tyser /* we have an overflow ... */ 125*84ad6884SPeter Tyser timestamp += now + GPT_FREE_RUNNING - lastdec; 126*84ad6884SPeter Tyser } 127*84ad6884SPeter Tyser lastdec = now; 128*84ad6884SPeter Tyser 129*84ad6884SPeter Tyser return timestamp; 130*84ad6884SPeter Tyser } 131*84ad6884SPeter Tyser 132*84ad6884SPeter Tyser void udelay_masked(unsigned long usec) 133*84ad6884SPeter Tyser { 134*84ad6884SPeter Tyser return udelay(usec); 135*84ad6884SPeter Tyser } 136*84ad6884SPeter Tyser 137*84ad6884SPeter Tyser /* 138*84ad6884SPeter Tyser * This function is derived from PowerPC code (read timebase as long long). 139*84ad6884SPeter Tyser * On ARM it just returns the timer value. 140*84ad6884SPeter Tyser */ 141*84ad6884SPeter Tyser unsigned long long get_ticks(void) 142*84ad6884SPeter Tyser { 143*84ad6884SPeter Tyser return get_timer(0); 144*84ad6884SPeter Tyser } 145*84ad6884SPeter Tyser 146*84ad6884SPeter Tyser /* 147*84ad6884SPeter Tyser * This function is derived from PowerPC code (timebase clock frequency). 148*84ad6884SPeter Tyser * On ARM it returns the number of timer ticks per second. 149*84ad6884SPeter Tyser */ 150*84ad6884SPeter Tyser ulong get_tbclk(void) 151*84ad6884SPeter Tyser { 152*84ad6884SPeter Tyser return CONFIG_SPEAR_HZ; 153*84ad6884SPeter Tyser } 154