1 #include <stdio.h>
2 #include "platform.h"
3 #include "xil_types.h"
4 #include "xscugic.h"
5 #include "xscutimer.h"
6 #include "xscuwdt.h"
7 #include "xil_exception.h"
8
9 static void TimerInterruptHandler(void *CallBackRef)
10 {
11 static int sec = 0;
12 printf("ScuTimer %d Seconds\n", sec++);
13
14 // Clears the interrupt status
15 XScuTimer *TimerInstPtr = (XScuTimer*)CallBackRef;
16 XScuTimer_ClearInterruptStatus(TimerInstPtr);
17 }
18
19 static void ScuWdtInterruptHandler(void *CallBackRef)
20 {
21 static int sec = 0;
22 printf("ScuWdt %d Seconds\n", sec++);
23
24 // Clears the interrupt status
25 XScuWdt *ScuWdtInstPtr = (XScuWdt *)CallBackRef;
26 XScuWdt_WriteReg(ScuWdtInstPtr->Config.BaseAddr, XSCUWDT_ISR_OFFSET, 0UL);
27 }
28
29 int main(void)
30 {
31 init_platform();
32
33 //---------------------------------------------------------------------------
34 // Timer initialization
35 //---------------------------------------------------------------------------
36 // Lookup the Timer configuration based on the unique device ID
37 XScuTimer_Config *TimerConfigPtr;
38 TimerConfigPtr = XScuTimer_LookupConfig(XPAR_XSCUTIMER_0_DEVICE_ID);
39
40 // Initialize a specific timer instance/driver
41 XScuTimer XScuTimerInst;
42 XScuTimer_CfgInitialize(&XScuTimerInst, TimerConfigPtr, TimerConfigPtr->BaseAddr);
43 // Run a self-test on the timer
44 XScuTimer_SelfTest(&XScuTimerInst);
45
46 //---------------------------------------------------------------------------
47 // Timer configure
48 //---------------------------------------------------------------------------
49 // Write to the timer load register
50 // From ARM DDI0407I_cortex_a9_mpcore_r4p1_trm.pdf reference, timers are always
51 // clocked at 1/2 of the CPU frequency (CPU_3x2x), now CPU frequency now is 666MHz, so the timer is 333MHz
52 // 333_000_000 * 1(s) - 1 = 332_999_999 = 0x13D92D3F
53 XScuTimer_LoadTimer(&XScuTimerInst, 0x13D92D3F);
54 // Enable auto-reload mode
55 XScuTimer_EnableAutoReload(&XScuTimerInst);
56 // Start timer
57 XScuTimer_Start(&XScuTimerInst);
58
59 XScuWdt_Config *ScuWdtConfigPtr;
60 ScuWdtConfigPtr = XScuWdt_LookupConfig(XPAR_SCUWDT_0_DEVICE_ID);
61
62 XScuWdt XScuWdtInst;
63 XScuWdt_CfgInitialize(&XScuWdtInst, ScuWdtConfigPtr, ScuWdtConfigPtr->BaseAddr);
64 XScuWdt_SelfTest(&XScuWdtInst);
65
66 XScuWdt_LoadWdt(&XScuWdtInst, 0x13D92D3F << 1UL);
67 XScuWdt_SetTimerMode(&XScuWdtInst);
68 XScuWdt_EnableAutoReload(&XScuWdtInst);
69 XScuWdt_Start(&XScuWdtInst);
70
71 //---------------------------------------------------------------------------
72 // Interrupt Controller initialization
73 //---------------------------------------------------------------------------
74 XScuGic XScuGicInst;
75 XScuGic_Config *XScuGic_ConfigPtr;
76
77 XScuGic_ConfigPtr = XScuGic_LookupConfig(XPAR_SCUGIC_SINGLE_DEVICE_ID);
78
79 // CfgInitialize a specific interrupt controller instance/driver
80 XScuGic_CfgInitialize(&XScuGicInst, XScuGic_ConfigPtr, XScuGic_ConfigPtr->CpuBaseAddress);
81
82 //---------------------------------------------------------------------------
83 // Interrupt system setup
84 //---------------------------------------------------------------------------
85 // Makes the connection between the Id of the exception source and the associated Handler
86 Xil_ExceptionRegisterHandler(XIL_EXCEPTION_ID_INT, (Xil_ExceptionHandler)XScuGic_InterruptHandler, &XScuGicInst);
87 // Enable Exceptions
88 Xil_ExceptionEnableMask(XIL_EXCEPTION_IRQ);
89
90 //---------------------------------------------------------------------------
91 // Register Interrupt Handler
92 //---------------------------------------------------------------------------
93 // Makes the connection between the Int_Id of the interrupt source and the associated handler
94 XScuGic_Connect(&XScuGicInst, XPAR_SCUTIMER_INTR, (Xil_ExceptionHandler)TimerInterruptHandler, (void *)&XScuTimerInst);
95 XScuGic_Connect(&XScuGicInst, XPAR_SCUWDT_INTR, (Xil_ExceptionHandler)ScuWdtInterruptHandler, (void *)&XScuWdtInst);
96
97 //---------------------------------------------------------------------------
98 // Enable Timer interrupt in the controller
99 //---------------------------------------------------------------------------
100 // Enable the Timer interrupt
101 XScuTimer_EnableInterrupt(&XScuTimerInst);
102
103 u32 Register;
104 Register = XScuWdt_ReadReg(XScuWdtInst.Config.BaseAddr, XSCUWDT_CONTROL_OFFSET);
105 XScuWdt_SetControlReg(&XScuWdtInst, XSCUWDT_CONTROL_IT_ENABLE_MASK | Register);
106
107 XScuGic_Enable(&XScuGicInst, XPAR_SCUTIMER_INTR);
108 XScuGic_Enable(&XScuGicInst, XPAR_SCUWDT_INTR);
109
110 printf("GIC SCUTimer ...\n");
111 while(1);
112
113 cleanup_platform();
114 return 0;
115 }
