Daniel Hellstrom | b330990 | 2008-03-28 10:00:33 +0100 | [diff] [blame] | 1 | /* Initializes CPU and basic hardware such as memory |
| 2 | * controllers, IRQ controller and system timer 0. |
| 3 | * |
| 4 | * (C) Copyright 2007 |
| 5 | * Daniel Hellstrom, Gaisler Research, daniel@gaisler.com |
| 6 | * |
| 7 | * See file CREDITS for list of people who contributed to this |
| 8 | * project. |
| 9 | * |
| 10 | * This program is free software; you can redistribute it and/or |
| 11 | * modify it under the terms of the GNU General Public License as |
| 12 | * published by the Free Software Foundation; either version 2 of |
| 13 | * the License, or (at your option) any later version. |
| 14 | * |
| 15 | * This program is distributed in the hope that it will be useful, |
| 16 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 18 | * GNU General Public License for more details. |
| 19 | * |
| 20 | * You should have received a copy of the GNU General Public License |
| 21 | * along with this program; if not, write to the Free Software |
| 22 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
| 23 | * MA 02111-1307 USA |
| 24 | * |
| 25 | */ |
| 26 | |
| 27 | #include <common.h> |
| 28 | #include <asm/asi.h> |
| 29 | #include <asm/leon.h> |
| 30 | |
| 31 | #include <config.h> |
| 32 | |
| 33 | DECLARE_GLOBAL_DATA_PTR; |
| 34 | |
| 35 | /* reset CPU (jump to 0, without reset) */ |
| 36 | void start(void); |
| 37 | |
| 38 | struct { |
| 39 | gd_t gd_area; |
| 40 | bd_t bd; |
| 41 | } global_data; |
| 42 | |
| 43 | /* |
| 44 | * Breath some life into the CPU... |
| 45 | * |
| 46 | * Set up the memory map, |
| 47 | * initialize a bunch of registers. |
| 48 | * |
| 49 | * Run from FLASH/PROM: |
Loïc Minier | 6052cba | 2011-02-03 22:04:26 +0100 | [diff] [blame] | 50 | * - until memory controller is set up, only registers available |
Daniel Hellstrom | b330990 | 2008-03-28 10:00:33 +0100 | [diff] [blame] | 51 | * - no global variables available for writing |
Loïc Minier | 6052cba | 2011-02-03 22:04:26 +0100 | [diff] [blame] | 52 | * - constants available |
Daniel Hellstrom | b330990 | 2008-03-28 10:00:33 +0100 | [diff] [blame] | 53 | */ |
| 54 | |
| 55 | void cpu_init_f(void) |
| 56 | { |
| 57 | LEON2_regs *leon2 = (LEON2_regs *) LEON2_PREGS; |
| 58 | |
| 59 | /* initialize the IRQMP */ |
| 60 | leon2->Interrupt_Force = 0; |
| 61 | leon2->Interrupt_Pending = 0; |
| 62 | leon2->Interrupt_Clear = 0xfffe; /* clear all old pending interrupts */ |
| 63 | leon2->Interrupt_Mask = 0xfffe0000; /* mask all IRQs */ |
| 64 | |
| 65 | /* cache */ |
| 66 | |
| 67 | /* I/O port setup */ |
| 68 | #ifdef LEON2_IO_PORT_DIR |
| 69 | leon2->PIO_Direction = LEON2_IO_PORT_DIR; |
| 70 | #endif |
| 71 | #ifdef LEON2_IO_PORT_DATA |
| 72 | leon2->PIO_Data = LEON2_IO_PORT_DATA; |
| 73 | #endif |
| 74 | #ifdef LEON2_IO_PORT_INT |
| 75 | leon2->PIO_Interrupt = LEON2_IO_PORT_INT; |
| 76 | #else |
| 77 | leon2->PIO_Interrupt = 0; |
| 78 | #endif |
| 79 | } |
| 80 | |
| 81 | void cpu_init_f2(void) |
| 82 | { |
| 83 | |
| 84 | } |
| 85 | |
| 86 | /* |
| 87 | * initialize higher level parts of CPU like time base and timers |
| 88 | */ |
| 89 | int cpu_init_r(void) |
| 90 | { |
| 91 | LEON2_regs *leon2 = (LEON2_regs *) LEON2_PREGS; |
| 92 | |
| 93 | /* initialize prescaler common to all timers to 1MHz */ |
| 94 | leon2->Scaler_Counter = leon2->Scaler_Reload = |
| 95 | (((CONFIG_SYS_CLK_FREQ / 1000) + 500) / 1000) - 1; |
| 96 | |
| 97 | return (0); |
| 98 | } |
| 99 | |
| 100 | /* Uses Timer 0 to get accurate |
| 101 | * pauses. Max 2 raised to 32 ticks |
| 102 | * |
| 103 | */ |
| 104 | void cpu_wait_ticks(unsigned long ticks) |
| 105 | { |
| 106 | unsigned long start = get_timer(0); |
| 107 | while (get_timer(start) < ticks) ; |
| 108 | } |
| 109 | |
| 110 | /* initiate and setup timer0 interrupt to 1MHz |
| 111 | * Return irq number for timer int or a negative number for |
| 112 | * dealing with self |
| 113 | */ |
| 114 | int timer_interrupt_init_cpu(void) |
| 115 | { |
| 116 | LEON2_regs *leon2 = (LEON2_regs *) LEON2_PREGS; |
| 117 | |
| 118 | /* 1ms ticks */ |
| 119 | leon2->Timer_Counter_1 = 0; |
| 120 | leon2->Timer_Reload_1 = 999; /* (((1000000 / 100) - 1)) */ |
| 121 | leon2->Timer_Control_1 = |
| 122 | (LEON2_TIMER_CTRL_EN | LEON2_TIMER_CTRL_RS | LEON2_TIMER_CTRL_LD); |
| 123 | |
| 124 | return LEON2_TIMER1_IRQNO; |
| 125 | } |
| 126 | |
| 127 | /* |
| 128 | * This function is intended for SHORT delays only. |
| 129 | */ |
| 130 | unsigned long cpu_usec2ticks(unsigned long usec) |
| 131 | { |
| 132 | /* timer set to 1kHz ==> 1 clk tick = 1 msec */ |
| 133 | if (usec < 1000) |
| 134 | return 1; |
| 135 | return (usec / 1000); |
| 136 | } |
| 137 | |
| 138 | unsigned long cpu_ticks2usec(unsigned long ticks) |
| 139 | { |
| 140 | /* 1tick = 1usec */ |
| 141 | return ticks * 1000; |
| 142 | } |