Sascha Hauer | 9b56f4f | 2008-03-26 20:40:42 +0100 | [diff] [blame] | 1 | /* |
| 2 | * (C) Copyright 2007 |
| 3 | * Sascha Hauer, Pengutronix |
| 4 | * |
| 5 | * See file CREDITS for list of people who contributed to this |
| 6 | * project. |
| 7 | * |
| 8 | * This program is free software; you can redistribute it and/or |
| 9 | * modify it under the terms of the GNU General Public License as |
| 10 | * published by the Free Software Foundation; either version 2 of |
| 11 | * the License, or (at your option) any later version. |
| 12 | * |
| 13 | * This program is distributed in the hope that it will be useful, |
| 14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 16 | * GNU General Public License for more details. |
| 17 | * |
| 18 | * You should have received a copy of the GNU General Public License |
| 19 | * along with this program; if not, write to the Free Software |
| 20 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
| 21 | * MA 02111-1307 USA |
| 22 | */ |
| 23 | |
| 24 | #include <common.h> |
| 25 | #include <asm/arch/mx31-regs.h> |
| 26 | |
| 27 | #define TIMER_BASE 0x53f90000 /* General purpose timer 1 */ |
| 28 | |
| 29 | /* General purpose timers registers */ |
| 30 | #define GPTCR __REG(TIMER_BASE) /* Control register */ |
| 31 | #define GPTPR __REG(TIMER_BASE + 0x4) /* Prescaler register */ |
| 32 | #define GPTSR __REG(TIMER_BASE + 0x8) /* Status register */ |
| 33 | #define GPTCNT __REG(TIMER_BASE + 0x24) /* Counter register */ |
| 34 | |
| 35 | /* General purpose timers bitfields */ |
| 36 | #define GPTCR_SWR (1<<15) /* Software reset */ |
| 37 | #define GPTCR_FRR (1<<9) /* Freerun / restart */ |
| 38 | #define GPTCR_CLKSOURCE_32 (4<<6) /* Clock source */ |
| 39 | #define GPTCR_TEN (1) /* Timer enable */ |
| 40 | |
Magnus Lilja | 8c4ebec | 2008-08-29 10:36:17 +0200 | [diff] [blame^] | 41 | static ulong timestamp; |
| 42 | static ulong lastinc; |
| 43 | |
Sascha Hauer | 9b56f4f | 2008-03-26 20:40:42 +0100 | [diff] [blame] | 44 | /* nothing really to do with interrupts, just starts up a counter. */ |
| 45 | int interrupt_init (void) |
| 46 | { |
| 47 | int i; |
| 48 | |
| 49 | /* setup GP Timer 1 */ |
| 50 | GPTCR = GPTCR_SWR; |
| 51 | for ( i=0; i<100; i++) GPTCR = 0; /* We have no udelay by now */ |
| 52 | GPTPR = 0; /* 32Khz */ |
| 53 | GPTCR |= GPTCR_CLKSOURCE_32 | GPTCR_TEN; /* Freerun Mode, PERCLK1 input */ |
| 54 | |
| 55 | return 0; |
| 56 | } |
| 57 | |
| 58 | void reset_timer_masked (void) |
| 59 | { |
Magnus Lilja | 8c4ebec | 2008-08-29 10:36:17 +0200 | [diff] [blame^] | 60 | /* reset time */ |
| 61 | lastinc = GPTCNT; /* capture current incrementer value time */ |
| 62 | timestamp = 0; /* start "advancing" time stamp from 0 */ |
| 63 | } |
| 64 | |
| 65 | void reset_timer(void) |
| 66 | { |
| 67 | reset_timer_masked(); |
Sascha Hauer | 9b56f4f | 2008-03-26 20:40:42 +0100 | [diff] [blame] | 68 | } |
| 69 | |
| 70 | ulong get_timer_masked (void) |
| 71 | { |
Magnus Lilja | 8c4ebec | 2008-08-29 10:36:17 +0200 | [diff] [blame^] | 72 | ulong now = GPTCNT; /* current tick value */ |
| 73 | |
| 74 | if (now >= lastinc) /* normal mode (non roll) */ |
| 75 | /* move stamp forward with absolut diff ticks */ |
| 76 | timestamp += (now - lastinc); |
| 77 | else /* we have rollover of incrementer */ |
| 78 | timestamp += (0xFFFFFFFF - lastinc) + now; |
| 79 | lastinc = now; |
| 80 | return timestamp; |
Sascha Hauer | 9b56f4f | 2008-03-26 20:40:42 +0100 | [diff] [blame] | 81 | } |
| 82 | |
| 83 | ulong get_timer (ulong base) |
| 84 | { |
| 85 | return get_timer_masked () - base; |
| 86 | } |
| 87 | |
| 88 | void set_timer (ulong t) |
| 89 | { |
| 90 | } |
| 91 | |
| 92 | /* delay x useconds AND perserve advance timstamp value */ |
| 93 | void udelay (unsigned long usec) |
| 94 | { |
| 95 | ulong tmo, tmp; |
| 96 | |
| 97 | if (usec >= 1000) { /* if "big" number, spread normalization to seconds */ |
| 98 | tmo = usec / 1000; /* start to normalize for usec to ticks per sec */ |
| 99 | tmo *= CFG_HZ; /* find number of "ticks" to wait to achieve target */ |
| 100 | tmo /= 1000; /* finish normalize. */ |
| 101 | } else { /* else small number, don't kill it prior to HZ multiply */ |
| 102 | tmo = usec * CFG_HZ; |
| 103 | tmo /= (1000*1000); |
| 104 | } |
| 105 | |
| 106 | tmp = get_timer (0); /* get current timestamp */ |
| 107 | if ( (tmo + tmp + 1) < tmp )/* if setting this forward will roll time stamp */ |
| 108 | reset_timer_masked (); /* reset "advancing" timestamp to 0, set lastinc value */ |
| 109 | else |
| 110 | tmo += tmp; /* else, set advancing stamp wake up time */ |
| 111 | while (get_timer_masked () < tmo)/* loop till event */ |
| 112 | /*NOP*/; |
| 113 | } |
| 114 | |
| 115 | void reset_cpu (ulong addr) |
| 116 | { |
| 117 | __REG16(WDOG_BASE) = 4; |
| 118 | } |