source: rtems/bsps/powerpc/beatnik/start/bspstart.c @ 9964895

5
Last change on this file since 9964895 was 9964895, checked in by Sebastian Huber <sebastian.huber@…>, on 04/20/18 at 08:35:35

bsps: Move startup files to bsps

Adjust build support files to new directory layout.

This patch is a part of the BSP source reorganization.

Update #3285.

  • Property mode set to 100644
File size: 10.8 KB
Line 
1/*
2 *  This routine does the bulk of the system initialization.
3 */
4
5/*
6 *  COPYRIGHT (c) 1989-1998.
7 *  On-Line Applications Research Corporation (OAR).
8 *
9 *  The license and distribution terms for this file may be
10 *  found in the file LICENSE in this distribution or at
11 *  http://www.OARcorp.com/rtems/license.html.
12 *
13 *  Modified to support the MCP750.
14 *  Modifications Copyright (C) 1999 Eric Valette. valette@crf.canon.fr
15 *
16 *  Modified to support the Synergy VGM & Motorola PowerPC boards.
17 *  (C) by Till Straumann, <strauman@slac.stanford.edu>, 2002, 2004, 2005
18 *
19 *  Modified to support the mvme5500 BSP
20 *  (C) by Kate Feng <feng1@bnl.gov>, 2003, 2004
21 *      under the contract DE-AC02-98CH10886 with the Deaprtment of Energy
22 *
23 *  T. Straumann: 2005-2007; stolen again for 'beatnik'...
24 */
25#include <string.h>
26#include <stdlib.h>
27#include <ctype.h>
28
29#include <rtems/system.h>
30#include <rtems/libio.h>
31#include <rtems/libcsupport.h>
32#include <rtems/bspIo.h>
33#include <rtems/counter.h>
34#include <rtems/powerpc/powerpc.h>
35#include <rtems/sysinit.h>
36/*#include <bsp/consoleIo.h>*/
37#include <libcpu/spr.h>   /* registers.h is included here */
38#include <bsp.h>
39#include <bsp/bootcard.h>
40#include <bsp/uart.h>
41#include <bsp/pci.h>
42#include <bsp/gtreg.h>
43#include <bsp/gt_timer.h>
44#include <libcpu/bat.h>
45#include <libcpu/pte121.h>
46#include <libcpu/cpuIdent.h>
47#include <bsp/vectors.h>
48#include <bsp/VME.h>
49#include <bsp/vpd.h>
50
51#define SHOW_MORE_INIT_SETTINGS
52
53BSP_output_char_function_type     BSP_output_char = BSP_output_char_via_serial;
54BSP_polling_getchar_function_type BSP_poll_char = NULL;
55
56extern Triv121PgTbl BSP_pgtbl_setup(unsigned int *);
57extern void BSP_pgtbl_activate(Triv121PgTbl);
58extern void BSP_motload_pci_fixup(void);
59
60extern unsigned long __rtems_end[];
61
62/* We really shouldn't use these since MMUoff also sets IP;
63 * nevertheless, during early init I don't care for now
64 */
65extern void MMUoff(void);
66extern void MMUon(void);
67
68extern uint32_t probeMemoryEnd(void);
69
70SPR_RW(SPRG0)
71SPR_RW(SPRG1)
72SPR_RO(HID1)
73
74/* Table of PLL multipliers for 7455/7457:
7501000   2     00010   7.5       00000   11.5      00001   17
7610000   3     11000   8         10111   12        00101   18
7710100   4     01100   8.5       11111   12.5      00111   20
7810110   5     01111   9         01011   13        01001   21
7910010   5.5   01110   9.5       11100   13.5      01101   24
8011010   6     10101   10        11001   14        11101   28
8101010   6.5   10001   10.5      00011   15        00110   bypass
8200100   7     10011   11        11011   16        11110   off
83*/
84
85/* Sorted according to CFG bits and multiplied by 2 it looks
86 * like this (note that this is in sequential order, not
87 * tabulated as above)
88 */
89signed char mpc7450PllMultByTwo[32] = {
9023,       34,           15,           30,
9114,       36,           2/*bypass*/,  40,
924,        42,           13,           26,
9317,       48,           19,           18,
946,        21,           11,           22,
958,        20,           10,           24,
9616,       28,           12,           32,
9727,       56,           0/*off*/,     25,
98};
99
100uint32_t bsp_clicks_per_usec         = 0;
101
102/*
103 * Total memory using probing.
104 */
105unsigned int BSP_mem_size;
106
107/*
108 * PCI Bus Frequency
109 */
110unsigned int BSP_bus_frequency       = 0xdeadbeef;
111/*
112 * processor clock frequency
113 */
114unsigned int BSP_processor_frequency = 0xdeadbeef;
115
116/*
117 * Time base divisior (bus freq / TB clock)
118 */
119unsigned int BSP_time_base_divisor   = 4000; /* most 604+ CPUs seem to use this */
120
121/* Board identification string */
122char BSP_productIdent[20] = {0};
123char BSP_serialNumber[20] = {0};
124
125/* VPD appends an extra char -- what for ? */
126char BSP_enetAddr0[7] = {0};
127char BSP_enetAddr1[7] = {0};
128
129char *rtems_progname;
130
131#define CMDLINE_BUF_SIZE        2048
132
133static char cmdline_buf[CMDLINE_BUF_SIZE];
134char *BSP_commandline_string = cmdline_buf;
135
136/* this routine is called early and must be safe with a not properly
137 * aligned stack
138 */
139char *save_boot_params(
140  void *r3,
141  void *r4,
142  void *r5,
143  char *cmdline_start,
144  char *cmdline_end
145)
146{
147int             i=cmdline_end-cmdline_start;
148        if ( i >= CMDLINE_BUF_SIZE )
149                i = CMDLINE_BUF_SIZE-1;
150        else if ( i < 0 )
151                i = 0;
152        memmove(cmdline_buf, cmdline_start, i);
153        cmdline_buf[i]=0;
154    return cmdline_buf;
155}
156
157static BSP_BoardType    board_type = Unknown;
158
159BSP_BoardType
160BSP_getBoardType( void )
161{
162        return board_type;
163}
164
165/*
166 *  bsp_start
167 *
168 *  This routine does the bulk of the system initialization.
169 */
170
171void bsp_start( void )
172{
173  unsigned char  *stack;
174  char           *chpt;
175  uint32_t       intrStackStart;
176  uint32_t       intrStackSize;
177
178  Triv121PgTbl  pt=0;
179
180  VpdBufRec vpdData [] = {
181        { key: ProductIdent, instance: 0, buf: BSP_productIdent, buflen: sizeof(BSP_productIdent) - 1 },
182        { key: SerialNumber, instance: 0, buf: BSP_serialNumber, buflen: sizeof(BSP_serialNumber) - 1 },
183        { key: CpuClockHz,   instance: 0, buf: &BSP_processor_frequency, buflen: sizeof(BSP_processor_frequency)  },
184        { key: BusClockHz,   instance: 0, buf: &BSP_bus_frequency, buflen: sizeof(BSP_bus_frequency)  },
185        { key: EthernetAddr, instance: 0, buf: BSP_enetAddr0, buflen: sizeof(BSP_enetAddr0) },
186        { key: EthernetAddr, instance: 1, buf: BSP_enetAddr1, buflen: sizeof(BSP_enetAddr1) },
187        VPD_END
188  };
189
190  /* T. Straumann: 4/2005
191   *
192   * Need to map the system registers early, so we can printk...
193   * (otherwise we silently die)
194   */
195  /* map the PCI 0, 1 Domain I/O space, GT64260B registers
196   * and the reserved area so that the size is the power of 2.
197   */
198  setdbat(7, BSP_DEV_AND_PCI_IO_BASE, BSP_DEV_AND_PCI_IO_BASE, BSP_DEV_AND_PCI_IO_SIZE, IO_PAGE);
199
200  /* Intersperse messages with actions to help locate problems */
201  printk("-----------------------------------------\n");
202
203  /*
204   * Get CPU identification dynamically. Note that the get_ppc_cpu_type() & friends functions
205   * store the result in global variables so that it can be used latter...
206   * This also verifies that we run on a known CPU.
207   */
208  get_ppc_cpu_type();
209  get_ppc_cpu_revision();
210
211  /* Make sure we detect a known host bridge */
212  BSP_getDiscoveryVersion(/* assert detection */ 1);
213
214  printk("Welcome to RTEMS %s\n", _RTEMS_version );
215
216  /* Leave all caches as MotLoad left them. Seems to be fine */
217
218  /*
219   * the initial stack  has aready been set to this value in start.S
220   * so there is no need to set it in r1 again... It is just for info
221   * so that it can be printed without accessing R1.
222   */
223  __asm__ volatile("mr %0, 1":"=r"(stack));
224
225  /* tag the bottom (T. Straumann 6/36/2001 <strauman@slac.stanford.edu>) */
226
227  *((uint32_t *)stack) = 0;
228
229  /*
230   * Initialize the interrupt related settings
231   * SPRG0 = interrupt nesting level count
232   * SPRG1 = software managed IRQ stack
233   *
234   * This could be done latter (e.g in IRQ_INIT) but it helps to understand
235   * some settings below...
236   */
237  intrStackStart = (uint32_t)__rtems_end;
238  intrStackSize  = rtems_configuration_get_interrupt_stack_size();
239
240  /*
241   * Initialize default raw exception handlers. See vectors/vectors_init.c
242   */
243  ppc_exc_initialize(intrStackStart, intrStackSize);
244
245  printk("CPU: %s\n", get_ppc_cpu_type_name(current_ppc_cpu));
246
247  /*
248   * Initialize RTEMS IRQ system
249   */
250   BSP_rtems_irq_mng_init(0);
251
252  BSP_vpdRetrieveFields(vpdData);
253
254  if ( !strncmp(BSP_productIdent,"MVME5500",8) )
255        board_type = MVME5500;
256  else if ( !strncmp(BSP_productIdent,"MVME6100",8) )
257        board_type = MVME6100;
258
259  printk("Board Type: %s (S/N %s)\n",
260                BSP_productIdent[0] ? BSP_productIdent : "n/a",
261                BSP_serialNumber[0] ? BSP_serialNumber : "n/a");
262
263  if ( 0xdeadbeef == BSP_bus_frequency ) {
264        BSP_bus_frequency       = 133333333;
265        printk("Bus Clock Freq NOT FOUND in VPD; using %10u Hz\n",
266                BSP_bus_frequency);
267  } else {
268        printk("Bus Clock Freq:  %10u Hz\n",
269                BSP_bus_frequency);
270  }
271
272  if ( 0xdeadbeef == BSP_processor_frequency ) {
273        BSP_processor_frequency  = BSP_bus_frequency/2;
274        BSP_processor_frequency *= mpc7450PllMultByTwo[ (_read_HID1() >> (31-19)) & 31 ];
275  }
276  printk("CPU Clock Freq:  %10u Hz\n", BSP_processor_frequency);
277       
278  /* probe real memory size; if it's more than 256M we can't currently access it
279   * since at this point only BAT-0 maps 0..256M
280   */
281  BSP_mem_size                          =  probeMemoryEnd();
282
283  if ( (chpt = strstr(BSP_commandline_string,"MEMSZ=")) ) {
284                char            *endp;
285                uint32_t        sz;
286                chpt+=6 /* strlen("MEMSZ=") */;
287                sz = strtoul(chpt, &endp, 0);
288                if ( endp != chpt )
289                        BSP_mem_size = sz;
290  }
291
292  printk("Memory:          %10u bytes\n", BSP_mem_size);
293
294  if ( BSP_mem_size > 0x10000000 ) {
295        uint32_t s;
296        if ( BSP_mem_size > 0x80000000 ) {
297                BSP_mem_size = 0x80000000;
298                printk("Memory clipped to 0x%08x for now, sorry\n", BSP_mem_size);
299        }
300        for ( s = 0x20000000; s < BSP_mem_size ; s<<=1)
301                ;
302        MMUoff();
303        /* since it's currently in use we must first surrender it */
304        setdbat(0, 0, 0, 0, 0);
305        setdbat(0, 0, 0, s, _PAGE_RW);
306        MMUon();
307  }
308
309  printk("-----------------------------------------\n");
310
311  /* Maybe not setup yet because of the warning message */
312
313  /* Allocate and set up the page table mappings
314   * This is only available on >604 CPUs.
315   *
316   * NOTE: This setup routine may modify the available memory
317   *       size. It is essential to call it before
318   *       calculating the workspace etc.
319   */
320  pt = BSP_pgtbl_setup(&BSP_mem_size);
321  if (!pt)
322     printk("WARNING: unable to setup page tables.\n");
323
324#ifdef SHOW_MORE_INIT_SETTINGS
325  printk("Now BSP_mem_size = 0x%x\n",BSP_mem_size);
326#endif
327
328  /*
329   * Set up our hooks
330   */
331
332  bsp_clicks_per_usec = BSP_bus_frequency/(BSP_time_base_divisor * 1000);
333  rtems_counter_initialize_converter(
334    BSP_bus_frequency / (BSP_time_base_divisor / 1000)
335  );
336
337#ifdef SHOW_MORE_INIT_SETTINGS
338  printk(
339    "Configuration.work_space_size = %x\n",
340    rtems_configuration_get_work_space_size()
341  );
342#endif
343
344  /* Activate the page table mappings only after
345   * initializing interrupts because the irq_mng_init()
346   * routine needs to modify the text
347   */           
348  if ( pt ) {
349#ifdef SHOW_MORE_INIT_SETTINGS
350    printk("Page table setup finished; will activate it NOW...\n");
351#endif
352    BSP_pgtbl_activate(pt);
353  }
354
355#ifdef SHOW_MORE_INIT_SETTINGS
356  printk("Going to start PCI buses scanning and initialization\n");
357#endif
358  BSP_pci_initialize();
359
360  /* need to tweak the motload setup */
361  BSP_motload_pci_fixup();
362
363  /* map 512M, 256 for PCI 256 for VME */
364  setdbat(5,BSP_PCI_HOSE0_MEM_BASE, BSP_PCI_HOSE0_MEM_BASE, BSP_PCI_HOSE0_MEM_SIZE, IO_PAGE);
365  setdbat(6,BSP_PCI_HOSE1_MEM_BASE, BSP_PCI_HOSE1_MEM_BASE, 0x10000000, IO_PAGE);
366
367#ifdef SHOW_MORE_INIT_SETTINGS
368  printk("Number of PCI buses found is : %d\n", pci_bus_count());
369#endif
370
371  /*
372   * Initialize hardware timer facility (not used by BSP itself)
373   * Needs PCI to identify discovery version...
374   */
375  BSP_timers_initialize();
376
377#ifdef SHOW_MORE_INIT_SETTINGS
378  printk("MSR 0x%lx \n", _read_MSR());
379  printk("Exit from bspstart\n");
380#endif
381}
382
383RTEMS_SYSINIT_ITEM(
384  BSP_vme_config,
385  RTEMS_SYSINIT_BSP_PRE_DRIVERS,
386  RTEMS_SYSINIT_ORDER_MIDDLE
387);
Note: See TracBrowser for help on using the repository browser.