1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
|
#include "io.h"
int main(void)
{
long long dsp_i, dsp_o;
long long ccond_i, outflag_i, efi_i, c_i, scount_i, pos_i;
long long ccond_o, outflag_o, efi_o, c_o, scount_o, pos_o;
long long ccond_r, outflag_r, efi_r, c_r, scount_r, pos_r;
ccond_i = 0x000000BC;/* 4 */
outflag_i = 0x0000001B;/* 3 */
efi_i = 0x00000001;/* 5 */
c_i = 0x00000001;/* 2 */
scount_i = 0x0000000F;/* 1 */
pos_i = 0x0000000C;/* 0 */
dsp_i = (ccond_i << 24) | \
(outflag_i << 16) | \
(efi_i << 14) | \
(c_i << 13) | \
(scount_i << 7) | \
pos_i;
ccond_r = ccond_i;
outflag_r = outflag_i;
efi_r = efi_i;
c_r = c_i;
scount_r = scount_i;
pos_r = pos_i;
__asm
("wrdsp %1, 0x3F\n\t"
"rddsp %0, 0x3F\n\t"
: "=r"(dsp_o)
: "r"(dsp_i)
);
ccond_o = (dsp_o >> 24) & 0xFF;
outflag_o = (dsp_o >> 16) & 0xFF;
efi_o = (dsp_o >> 14) & 0x01;
c_o = (dsp_o >> 14) & 0x01;
scount_o = (dsp_o >> 7) & 0x3F;
pos_o = dsp_o & 0x1F;
if ((ccond_o != ccond_r) || (outflag_o != outflag_r) || (efi_o != efi_r) \
|| (c_o != c_r) || (scount_o != scount_r) || (pos_o != pos_r)) {
printf("rddsp wrong\n");
return -1;
}
return 0;
}
|
