@@ -173,44 +173,6 @@ bool TC6Regs_SetPlca(TC6_t *pTC6, bool plcaEnable, uint8_t nodeId, uint8_t nodeC
173
173
return success;
174
174
}
175
175
176
- bool TC6Regs_SetDio (TC6_t *pTC6, bool dioa0, bool dioa1, bool dioa2)
177
- {
178
- static bool _dioa0 = false ;
179
- static bool _dioa1= false ;
180
- static bool _dioa2 = false ;
181
-
182
- TC6Reg_t *pReg = GetContext (pTC6);
183
- // EG0CTL 0x0226
184
- // EG1CTL 0x022C
185
- // EG2CTL 0x0232
186
- // PADCTRL 0x0088
187
- uint32_t regVal = (1 << 0 ) | (1 << 2 ) | (1 << 4 ); // set all pins as output
188
- while (pReg->initDone && !TC6_WriteRegister (pReg->pTC6 , 0x000A0088 , regVal, CONTROL_PROTECTION, NULL , NULL )) {
189
- TC6_Service (pReg->pTC6 , true );
190
- }
191
-
192
- regVal = 1 ; // means toggle
193
- if (dioa0 != _dioa0) {
194
- while (pReg->initDone && !TC6_WriteRegister (pReg->pTC6 , 0x000A0226 , regVal, CONTROL_PROTECTION, NULL , NULL )) {
195
- TC6_Service (pReg->pTC6 , true );
196
- }
197
- _dioa0 = dioa0;
198
- }
199
- if (dioa1 != _dioa1) {
200
- while (pReg->initDone && !TC6_WriteRegister (pReg->pTC6 , 0x000A022C , regVal, CONTROL_PROTECTION, NULL , NULL )) {
201
- TC6_Service (pReg->pTC6 , true );
202
- }
203
- _dioa1 = dioa1;
204
- }
205
- if (dioa2 != _dioa2) {
206
- while (pReg->initDone && !TC6_WriteRegister (pReg->pTC6 , 0x000A0232 , regVal, CONTROL_PROTECTION, NULL , NULL )) {
207
- TC6_Service (pReg->pTC6 , true );
208
- }
209
- _dioa2 = dioa2;
210
- }
211
- return true ;
212
- }
213
-
214
176
static bool is_dio_a0_op_done = false ;
215
177
void TC6_Dio_A0_Callback (TC6_t *pInst, bool success, uint32_t addr, uint32_t value, void *pTag, void *pGlobalTag)
216
178
{
0 commit comments