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