source: rtems/c/src/lib/libbsp/powerpc/mpc55xxevb/startup/bspstart.c @ dd8df59

4.11
Last change on this file since dd8df59 was dd8df59, checked in by Sebastian Huber <sebastian.huber@…>, on Nov 14, 2012 at 12:59:27 PM

bsps: Interrupt initialization error is fatal

  • Property mode set to 100644
File size: 3.0 KB
Line 
1/**
2 * @file
3 *
4 * @ingroup mpc55xx
5 *
6 * @brief BSP startup code.
7 */
8
9/*
10 * Copyright (c) 2008-2011 embedded brains GmbH.  All rights reserved.
11 *
12 *  embedded brains GmbH
13 *  Obere Lagerstr. 30
14 *  82178 Puchheim
15 *  Germany
16 *  <rtems@embedded-brains.de>
17 *
18 * The license and distribution terms for this file may be
19 * found in the file LICENSE in this distribution or at
20 * http://www.rtems.com/license/LICENSE.
21 */
22
23#include <mpc55xx/mpc55xx.h>
24#include <mpc55xx/regs.h>
25#include <mpc55xx/edma.h>
26#include <mpc55xx/emios.h>
27
28#include <string.h>
29
30#include <rtems.h>
31#include <rtems/config.h>
32
33#include <libcpu/powerpc-utility.h>
34#include <bsp/vectors.h>
35
36#include <bsp.h>
37#include <bsp/bootcard.h>
38#include <bsp/irq.h>
39#include <bsp/irq-generic.h>
40#include <bsp/linker-symbols.h>
41#include <bsp/start.h>
42#include <bsp/mpc55xx-config.h>
43
44/* Symbols defined in linker command file */
45LINKER_SYMBOL(mpc55xx_exc_vector_base);
46
47unsigned int bsp_clock_speed = 0;
48
49uint32_t bsp_clicks_per_usec = 0;
50
51void BSP_panic( char *s)
52{
53        rtems_interrupt_level level;
54
55        rtems_interrupt_disable( level);
56
57        printk( "%s PANIC %s\n", _RTEMS_version, s);
58
59        while (1) {
60                /* Do nothing */
61        }
62}
63
64void _BSP_Fatal_error( unsigned n)
65{
66        rtems_interrupt_level level;
67
68        rtems_interrupt_disable( level);
69
70        printk( "%s PANIC ERROR %u\n", _RTEMS_version, n);
71
72        while (1) {
73                /* Do nothing */
74        }
75}
76
77static void null_pointer_protection(void)
78{
79#ifdef MPC55XX_NULL_POINTER_PROTECTION
80        struct MMU_tag mmu = { .MAS0 = { .B = { .TLBSEL = 1, .ESEL = 1 } } };
81
82        PPC_SET_SPECIAL_PURPOSE_REGISTER(FSL_EIS_MAS0, mmu.MAS0.R);
83        __asm__ volatile ("tlbre");
84        mmu.MAS1.R = PPC_SPECIAL_PURPOSE_REGISTER(FSL_EIS_MAS1);
85        mmu.MAS1.B.VALID = 0;
86        PPC_SET_SPECIAL_PURPOSE_REGISTER(FSL_EIS_MAS1, mmu.MAS1.R);
87        __asm__ volatile ("tlbwe");
88#endif
89}
90
91void bsp_start(void)
92{
93        rtems_status_code sc = RTEMS_SUCCESSFUL;
94        ppc_cpu_id_t myCpu;
95        ppc_cpu_revision_t myCpuRevision;
96
97        null_pointer_protection();
98
99        /*
100         * make sure BSS/SBSS is cleared
101         */
102        memset(&bsp_section_bss_begin [0], 0, (size_t) bsp_section_bss_size);
103
104        /*
105         * Get CPU identification dynamically. Note that the get_ppc_cpu_type()
106         * function store the result in global variables so that it can be used
107         * latter...
108         */
109        myCpu = get_ppc_cpu_type();
110        myCpuRevision = get_ppc_cpu_revision();
111
112        /*
113         * determine clock speed
114         */
115        bsp_clock_speed = mpc55xx_get_system_clock() / MPC55XX_SYSTEM_CLOCK_DIVIDER;
116
117        /* Time reference value */
118        bsp_clicks_per_usec = bsp_clock_speed / 1000000;
119
120        /* Initialize exceptions */
121        ppc_exc_vector_base = (uint32_t) mpc55xx_exc_vector_base;
122        sc = ppc_exc_initialize(
123                PPC_INTERRUPT_DISABLE_MASK_DEFAULT,
124                (uintptr_t) bsp_section_work_begin,
125                rtems_configuration_get_interrupt_stack_size()
126        );
127        if (sc != RTEMS_SUCCESSFUL) {
128                BSP_panic( "Cannot initialize exceptions");
129        }
130        ppc_exc_set_handler(ASM_ALIGN_VECTOR, ppc_exc_alignment_handler);
131
132        /* Initialize interrupts */
133        bsp_interrupt_initialize();
134
135        mpc55xx_edma_init();
136        #ifdef MPC55XX_EMIOS_PRESCALER
137                mpc55xx_emios_initialize(MPC55XX_EMIOS_PRESCALER);
138        #endif
139}
Note: See TracBrowser for help on using the repository browser.