版主
主题
回帖0
积分10609
阅读权限200
注册时间2008-11-22
最后登录1970-1-1
在线时间 小时
|
楼主 |
发表于 2019-3-1 15:18
|
显示全部楼层
ZYNQ采用了结构指针加函数指针来实现复杂的功能还有它总之采用强制转换来实现类型转换,所以好多用了void *
- \! {0 t! j( f) j- ^# h7 ^. l& }6 k5 S$ V, j$ o ]: \2 q- K& a$ _: z1 ^
- W6 X/ X$ h* r2 T/ j: P! l#include <stdio.h>
" O' m3 p5 c. i6 E( R#include "xscugic.h"5 t, J# P+ K6 ]$ `3 u
#include "xil_exception.h"
" i$ G1 }* Q7 Q8 q) N2 A' x: e/ ]& Y; O
#define INT_CFG0_OFFSET 0x00000C00( u$ s; a0 l# p& p+ O
7 ~7 R# C2 Y5 X// Parameter definitions. A$ x- E, h e' p# i/ r! {
#define SW1_INT_ID 617 N% `' `6 y+ ~% t6 L
#define SW2_INT_ID 62
1 C G9 a* W1 P1 `0 \, v4 F3 |* b6 d#define SW3_INT_ID 63& V0 p( \1 z: y
#define INTC_DEVICE_ID XPAR_PS7_SCUGIC_0_DEVICE_ID
# g7 ]) L& B( I, O, |6 @) [#define INT_TYPE_RISING_EDGE 0x03
2 ~$ o; ~$ k1 b, R* u5 Y) e8 l#define INT_TYPE_HIGHLEVEL 0x01
7 X ] s' F3 @; b5 P# `1 A2 H#define INT_TYPE_MASK 0x039 |- I" c# p! ^# v: H7 p
% g! Y4 ~) _' O: L& n; n' ~2 ^* o! I- T% l
static XScuGic INTCInst;) n& Q* u2 r- \
0 S" J. Q* g& zstatic void SW_intr_Handler(void *param);
& U2 `8 H% e( T) `static int IntcInitFunction(u16 DeviceId);1 x& `7 }9 Y5 v, b1 m: ~8 h
+ G+ R: g9 a3 c/ `
static void SW_intr_Handler(void *param)
% X0 o% `& y! t2 m) x{
Y0 ~3 `/ Z0 O) h: ^ int sw_id = (int)param;9 x1 J8 s. X+ k$ L5 |/ \
printf("SW%d int\n\r", sw_id);! q i& `" Q, c; O
}
U; Y- I% j* F! u6 ~
3 N* t; |3 v% A" nvoid IntcTypeSetup(XScuGic *InstancePtr, int intId, int intType)8 V: f3 R) J: N# a! M
{0 M% K9 X4 M) U6 H! ~
int mask;: Q) q* F+ s: {* S2 u7 ^" R% X& ~- L
, l$ n+ }' ^: W9 e5 L* ^/ n
intType &= INT_TYPE_MASK;
- Q0 [; k5 u( L mask = XScuGic_DistReadReg(InstancePtr, INT_CFG0_OFFSET + (intId/16)*4);
# u4 _$ B2 V8 m+ C1 F mask &= ~(INT_TYPE_MASK << (intId%16)*2);
% q" w; ]+ h0 @$ v$ y mask |= intType << ((intId%16)*2);
& X( [0 \7 A2 K% T& z% d! o XScuGic_DistWriteReg(InstancePtr, INT_CFG0_OFFSET + (intId/16)*4, mask);1 w2 W( v. K! z
}
' P- k; @6 ^* _$ T; S
5 y$ Q3 Q4 {0 F% b1 c% h3 rint IntcInitFunction(u16 DeviceId)) c$ i" {6 @! f# E& k/ C
{
0 x& \: j+ }- V9 C+ K3 } XScuGic_Config *IntcConfig;1 c' \/ a/ \( p9 t0 Q$ h6 o0 \9 ]- L
int status;
" n- U; H/ {+ i t' I" M' ?
' _4 C }+ C* ^8 o& W K // Interrupt controller initialisation' {) L I: y& H3 p
IntcConfig = XScuGic_LookupConfig(DeviceId);9 W* q2 \% b/ F: R
status = XScuGic_CfgInitialize(&INTCInst, IntcConfig, IntcConfig->CpuBaseAddress);: X3 [3 V, { A2 b( U
if(status != XST_SUCCESS) return XST_FAILURE;
1 _2 w: k0 f: s( W5 Q
) ?0 y* a0 r) W7 ?- {3 o // Call to interrupt setup% d+ ^3 Y) x, w6 e- J3 A9 d
Xil_ExceptionRegisterHandler(XIL_EXCEPTION_ID_INT,3 S" c7 T/ |0 S' V! P
(Xil_ExceptionHandler)XScuGic_InterruptHandler,& s; J% m7 n! c' G7 g" P/ l' f
&INTCInst);1 R* v7 u& |" M; f# L l
Xil_ExceptionEnable();
4 t6 X4 c, p5 B! c# a6 H
* x$ ]; g' ]+ M9 L( L+ \ // Connect SW1~SW3 interrupt to handler
$ N6 \* f1 u, l1 ^) _3 x status = XScuGic_Connect(&INTCInst,
7 F- C+ C* ]8 J4 c4 D SW1_INT_ID,
% {) R; o [8 x7 p l0 k' U (Xil_ExceptionHandler)SW_intr_Handler," K* N6 Z; Y. A4 ?' p% ?" C
(void *)1);
! x$ t$ S4 }' L if(status != XST_SUCCESS) return XST_FAILURE;8 W. V9 a4 Z4 r: B" a$ m
2 w) e4 f/ s0 X7 i! {
status = XScuGic_Connect(&INTCInst,
9 D( Y1 J% \- u; |0 E3 s SW2_INT_ID,
: E" y \% q0 {- E" }; e (Xil_ExceptionHandler)SW_intr_Handler,- g( H; |& Q! W: c
(void *)2);
9 K# G: y5 m( P$ Q) K# [8 ? if(status != XST_SUCCESS) return XST_FAILURE;6 f7 i, t. m# W- s
6 D& k; N/ }8 U* d* G
status = XScuGic_Connect(&INTCInst,1 j5 B% J6 H7 F
SW3_INT_ID,0 q1 S# T. C4 I- B4 ]# ^
(Xil_ExceptionHandler)SW_intr_Handler,
1 {* J4 |* X' I; \; O, H. z0 Q8 q (void *)3);
) W0 a7 b. `6 e, l& b( B7 j if(status != XST_SUCCESS) return XST_FAILURE;! A+ R A7 w8 J' T, S
2 _# s% f! @4 [7 d7 X // Set interrupt type of SW1~SW3 to rising edge8 D( t9 B8 {( \, B
IntcTypeSetup(&INTCInst, SW1_INT_ID, INT_TYPE_RISING_EDGE);
" k2 @0 |. |/ s" ^( e IntcTypeSetup(&INTCInst, SW2_INT_ID, INT_TYPE_RISING_EDGE);
p- U& @7 h/ l" t8 J( D4 h, c! G IntcTypeSetup(&INTCInst, SW3_INT_ID, INT_TYPE_RISING_EDGE); H4 n z5 `# A. F
3 j& A6 i* c# h2 i3 Z6 F // Enable SW1~SW3 interrupts in the controller7 o) P8 |/ [4 p, T7 W
XScuGic_Enable(&INTCInst, SW1_INT_ID);) M/ Q5 k1 D3 |1 O3 {& N
XScuGic_Enable(&INTCInst, SW2_INT_ID);# ^% u* b5 H; C3 X6 s
XScuGic_Enable(&INTCInst, SW3_INT_ID);
0 s. n5 y! N2 B; Z
7 e2 X: t# k ^5 g return XST_SUCCESS;
3 D( I3 y! q+ i$ Q3 z- x}
. r$ e" p$ t& X3 h! ?5 X" P* D# f# e, m$ c2 G( w) C& ]7 Q* A
int main(void)$ ]( O4 |- d/ K: i, w
{
! L/ F3 ~" x- V/ d5 S) H print("PL int test\n\r");5 o# o* F4 S$ x& `2 _. R8 N# ?
IntcInitFunction(INTC_DEVICE_ID);
' i8 E7 {7 B! J7 J P while(1);3 O+ c( Z# w1 t8 y) ^
return 0;9 I- o2 b+ { p( ]: `
}
5 { F e: ?0 a2 D8 j2 H# C' G) O* o6 h8 k) a$ c9 G6 s( I
! [, ]2 P+ i$ B! S( K2 ~& M' t# ~
$ @$ k, c1 o! E, c' L
|
|