Apps: Zynq: Update to use libmetal I/O and device
[processor-sdk/open-amp.git] / apps / system / generic / machine / zynq7 / 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  */
32 #include <string.h>
33 #include "xparameters.h"
34 #include "xil_exception.h"
35 #include "xscugic.h"
36 #include "xil_cache.h"
37 #include "metal/sys.h"
39 #define INTC_DEVICE_ID          XPAR_SCUGIC_0_DEVICE_ID
40 /** IPI IRQ ID */
41 #define VRING0_IPI_VECT         15
42 #define VRING1_IPI_VECT         14
44 XScuGic InterruptController;
46 extern void metal_irq_isr(unsigned int irq);
47 extern int platform_register_metal_device(void);
49 int zynq_a9_gic_initialize()
50 {
51         u32 Status;
53         Xil_ExceptionDisable();
55         XScuGic_Config *IntcConfig;     /* The configuration parameters of the interrupt controller */
57         /*
58          * Initialize the interrupt controller driver
59          */
60         IntcConfig = XScuGic_LookupConfig(INTC_DEVICE_ID);
61         if (NULL == IntcConfig) {
62                 return XST_FAILURE;
63         }
65         Status = XScuGic_CfgInitialize(&InterruptController, IntcConfig,
66                                        IntcConfig->CpuBaseAddress);
67         if (Status != XST_SUCCESS) {
68                 return XST_FAILURE;
69         }
71         /*
72          * Register the interrupt handler to the hardware interrupt handling
73          * logic in the ARM processor.
74          */
75         Xil_ExceptionRegisterHandler(XIL_EXCEPTION_ID_IRQ_INT,
76                         (Xil_ExceptionHandler)XScuGic_InterruptHandler,
77                         &InterruptController);
79         Xil_ExceptionEnable();
80         /* Connect IPI0 Interrupt ID with ISR */
81         XScuGic_Connect(&InterruptController, VRING0_IPI_VECT,
82                            (Xil_ExceptionHandler)metal_irq_isr,
83                            (void *)VRING0_IPI_VECT);
85         /* Connect IPI1 Interrupt ID with ISR */
86         XScuGic_Connect(&InterruptController, VRING1_IPI_VECT,
87                            (Xil_ExceptionHandler)metal_irq_isr,
88                            (void *)VRING1_IPI_VECT);
89         return 0;
90 }
92 void init_system()
93 {
94         struct metal_init_params metal_param = METAL_INIT_DEFAULTS;
96         metal_init(&metal_param);
97         zynq_a9_gic_initialize();
98         platform_register_metal_device();
99 }
101 void cleanup_system()
103         metal_finish();
104         Xil_DCacheDisable();
105         Xil_ICacheDisable();
106         Xil_DCacheInvalidate();
107         Xil_ICacheInvalidate();