cleanup: const definition, unused includes,...
[processor-sdk/open-amp.git] / apps / system / generic / machine / zynqmp_r5 / helper.c
2 /*
3  * Copyright (c) 2014, Mentor Graphics Corporation
4  * All rights reserved.
5  *
6  * Copyright (c) 2015 Xilinx, Inc. All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions are met:
10  *
11  * 1. Redistributions of source code must retain the above copyright notice,
12  *    this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright notice,
14  *    this list of conditions and the following disclaimer in the documentation
15  *    and/or other materials provided with the distribution.
16  * 3. Neither the name of the <ORGANIZATION> nor the names of its contributors
17  *    may be used to endorse or promote products derived from this software
18  *    without specific prior written permission.
19  *
20  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
21  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
24  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
25  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
26  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
27  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
28  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
29  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30  * POSSIBILITY OF SUCH DAMAGE.
31  */
33 #include "xparameters.h"
34 #include "xil_exception.h"
35 #include "xscugic.h"
36 #include "xil_cache.h"
37 #include "metal/sys.h"
38 #include "metal/irq.h"
39 #include "metal/system/generic/irq.h"
42 #define INTC_DEVICE_ID          XPAR_SCUGIC_0_DEVICE_ID
43 /** IPI IRQ ID */
44 #define IPI_IRQ_VECT_ID         65
46 extern int platform_register_metal_device(void);
48 static XScuGic InterruptController;
51 static int zynqmp_r5_gic_initialize(void)
52 {
53         u32 Status;
54         XScuGic_Config *IntcConfig;     /* The configuration parameters of the interrupt controller */
56         Xil_ExceptionDisable();
58         /*
59          * Initialize the interrupt controller driver
60          */
61         IntcConfig = XScuGic_LookupConfig(INTC_DEVICE_ID);
62         if (NULL == IntcConfig) {
63                 return XST_FAILURE;
64         }
66         Status = XScuGic_CfgInitialize(&InterruptController, IntcConfig,
67                                        IntcConfig->CpuBaseAddress);
68         if (Status != XST_SUCCESS) {
69                 return XST_FAILURE;
70         }
72         /*
73          * Register the interrupt handler to the hardware interrupt handling
74          * logic in the ARM processor.
75          */
76         Xil_ExceptionRegisterHandler(XIL_EXCEPTION_ID_IRQ_INT,
77                         (Xil_ExceptionHandler)XScuGic_InterruptHandler,
78                         &InterruptController);
80         Xil_ExceptionEnable();
82         /* Connect Interrupt ID with ISR */
83         XScuGic_Connect(&InterruptController, IPI_IRQ_VECT_ID,
84                            (Xil_ExceptionHandler)metal_irq_isr,
85                            (void *)IPI_IRQ_VECT_ID);
87         return 0;
88 }
90 void init_system(void)
91 {
92         struct metal_init_params metal_param = METAL_INIT_DEFAULTS;
94         metal_init(&metal_param);
95         zynqmp_r5_gic_initialize();
96         platform_register_metal_device();
97 }
99 void cleanup_system()
101         metal_finish();
103         Xil_DCacheDisable();
104         Xil_ICacheDisable();
105         Xil_DCacheInvalidate();
106         Xil_ICacheInvalidate();