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

4.11
Last change on this file since dafacfa7 was dafacfa7, checked in by Sebastian Huber <sebastian.huber@…>, on Jul 18, 2012 at 7:26:13 AM

bsp/mpc55xx: Add MPC55XX_SYSTEM_CLOCK_DIVIDER

  • Property mode set to 100644
File size: 3.4 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
44extern Heap_Control *RTEMS_Malloc_Heap;
45
46/* Symbols defined in linker command file */
47LINKER_SYMBOL(mpc55xx_exc_vector_base);
48
49unsigned int bsp_clock_speed = 0;
50
51uint32_t bsp_clicks_per_usec = 0;
52
53void BSP_panic( char *s)
54{
55        rtems_interrupt_level level;
56
57        rtems_interrupt_disable( level);
58
59        printk( "%s PANIC %s\n", _RTEMS_version, s);
60
61        while (1) {
62                /* Do nothing */
63        }
64}
65
66void _BSP_Fatal_error( unsigned n)
67{
68        rtems_interrupt_level level;
69
70        rtems_interrupt_disable( level);
71
72        printk( "%s PANIC ERROR %u\n", _RTEMS_version, n);
73
74        while (1) {
75                /* Do nothing */
76        }
77}
78
79static void null_pointer_protection(void)
80{
81#ifdef MPC55XX_NULL_POINTER_PROTECTION
82        struct MMU_tag mmu = { .MAS0 = { .B = { .TLBSEL = 1, .ESEL = 1 } } };
83
84        PPC_SET_SPECIAL_PURPOSE_REGISTER(FSL_EIS_MAS0, mmu.MAS0.R);
85        __asm__ volatile ("tlbre");
86        mmu.MAS1.R = PPC_SPECIAL_PURPOSE_REGISTER(FSL_EIS_MAS1);
87        mmu.MAS1.B.VALID = 0;
88        PPC_SET_SPECIAL_PURPOSE_REGISTER(FSL_EIS_MAS1, mmu.MAS1.R);
89        __asm__ volatile ("tlbwe");
90#endif
91}
92
93void bsp_start(void)
94{
95        rtems_status_code sc = RTEMS_SUCCESSFUL;
96        ppc_cpu_id_t myCpu;
97        ppc_cpu_revision_t myCpuRevision;
98
99        null_pointer_protection();
100
101        /*
102         * make sure BSS/SBSS is cleared
103         */
104        memset(&bsp_section_bss_begin [0], 0, (size_t) bsp_section_bss_size);
105
106        /*
107         * Get CPU identification dynamically. Note that the get_ppc_cpu_type()
108         * function store the result in global variables so that it can be used
109         * latter...
110         */
111        myCpu = get_ppc_cpu_type();
112        myCpuRevision = get_ppc_cpu_revision();
113
114        /*
115         * determine clock speed
116         */
117        bsp_clock_speed = mpc55xx_get_system_clock() / MPC55XX_SYSTEM_CLOCK_DIVIDER;
118
119        /* Time reference value */
120        bsp_clicks_per_usec = bsp_clock_speed / 1000000;
121
122        /* Initialize exceptions */
123        ppc_exc_vector_base = (uint32_t) mpc55xx_exc_vector_base;
124        sc = ppc_exc_initialize(
125                PPC_INTERRUPT_DISABLE_MASK_DEFAULT,
126                (uintptr_t) bsp_section_work_begin,
127                Configuration.interrupt_stack_size
128        );
129        if (sc != RTEMS_SUCCESSFUL) {
130                BSP_panic( "Cannot initialize exceptions");
131        }
132        ppc_exc_set_handler(ASM_ALIGN_VECTOR, ppc_exc_alignment_handler);
133
134        /* Initialize interrupts */
135        sc = bsp_interrupt_initialize();
136        if (sc != RTEMS_SUCCESSFUL) {
137                BSP_panic( "Cannot initialize interrupts");
138        }
139
140        mpc55xx_edma_init();
141        #ifdef MPC55XX_EMIOS_PRESCALER
142                mpc55xx_emios_initialize(MPC55XX_EMIOS_PRESCALER);
143        #endif
144}
145
146void bsp_pretasking_hook(void)
147{
148        #if MPC55XX_CHIP_TYPE / 10 == 564
149                _Heap_Extend(
150                        RTEMS_Malloc_Heap,
151                        bsp_section_rwextra_end,
152                        (uintptr_t) bsp_ram_end
153                                - (uintptr_t) bsp_section_rwextra_end,
154                        NULL
155                );
156        #endif
157}
Note: See TracBrowser for help on using the repository browser.