Debian Codegraph @

tools/ds_tests/twltouch/arm7/source/codec.c

raw
1 #include <nds.h>
2
3 static u32 cdcCurrentPage = -1;
4
5 void CDC_WriteRegister(u32 reg, u32 val);
6
7 void CDC_ChangePage(u32 page)
8 {
9 if (cdcCurrentPage == page)
10 return;
11
12 if (cdcCurrentPage == 0xFF)
13 CDC_WriteRegister(0x7F, page);
14 else
15 CDC_WriteRegister(0, page);
16
17 cdcCurrentPage = page;
18 }
19
20
21 void CDC_WriteRegister(u32 reg, u32 val)
22 {
23 while(REG_SPICNT & 0x80);
24
25 REG_SPICNT = 0x8A00;
26 REG_SPIDATA = (reg<<1) & 0xFF;
27
28 while(REG_SPICNT & 0x80);
29
30 REG_SPICNT = 0x8200;
31 REG_SPIDATA = val & 0xFF;
32 }
33
34 void CDC_WriteRegisterEx(u32 page, u32 reg, u32 val)
35 {
36 CDC_ChangePage(page);
37 CDC_WriteRegister(reg, val);
38 }
39
40 void CDC_WriteRegisters(u32 reg, u8* buf, u32 size)
41 {
42 if (size == 0)
43 return;
44
45
46 while(REG_SPICNT & 0x80);
47
48 REG_SPICNT = 0x8A00;
49 REG_SPIDATA = (reg<<1) & 0xFF;
50
51 while(REG_SPICNT & 0x80);
52
53 while(size-- > 1)
54 {
55 REG_SPIDATA = 0;
56
57 while(REG_SPICNT & 0x80);
58
59 *buf++ = REG_SPIDATA;
60 }
61
62 REG_SPICNT = 0x8200;
63 REG_SPIDATA = 0;
64
65 while(REG_SPICNT & 0x80);
66
67 *buf++ = REG_SPIDATA;
68 }
69
70 void CDC_WriteRegistersEx(u32 page, u32 reg, u8* buf, u32 size)
71 {
72 CDC_ChangePage(page);
73 CDC_WriteRegisters(reg, buf, size);
74 }
75
76 u32 CDC_ReadRegister(u32 reg)
77 {
78 while(REG_SPICNT & 0x80);
79
80 REG_SPICNT = 0x8A00;
81 REG_SPIDATA = ((reg<<1) | 1) & 0xFF;
82
83 while(REG_SPICNT & 0x80);
84
85 REG_SPICNT = 0x8200;
86 REG_SPIDATA = 0;
87
88 while(REG_SPICNT & 0x80);
89
90 return REG_SPIDATA;
91 }
92
93 u32 CDC_ReadRegisterEx(u32 page, u32 reg)
94 {
95 CDC_ChangePage(page);
96 return CDC_ReadRegister(reg);
97 }
98
99
100 void CDC_ReadRegisters(u32 reg, u8* buf, u32 size)
101 {
102 if (size == 0)
103 return;
104
105
106 while(REG_SPICNT & 0x80);
107
108 REG_SPICNT = 0x8A00;
109 REG_SPIDATA = ((reg<<1)|1) & 0xFF;
110
111 while(REG_SPICNT & 0x80);
112
113 while(size-- > 1)
114 {
115 REG_SPIDATA = 0;
116
117 while(REG_SPICNT & 0x80);
118
119 *buf++ = REG_SPIDATA;
120 }
121
122 REG_SPICNT = 0x8200;
123 REG_SPIDATA = 0;
124
125 while(REG_SPICNT & 0x80);
126
127 *buf++ = REG_SPIDATA;
128 }
129
130 void CDC_ReadRegistersEx(u32 page, u32 reg, u8* buf, u32 size)
131 {
132 CDC_ChangePage(page);
133 CDC_ReadRegisters(reg, buf, size);
134 }
135