@@ -173,44 +173,6 @@ bool TC6Regs_SetPlca(TC6_t *pTC6, bool plcaEnable, uint8_t nodeId, uint8_t nodeC
173173 return success;
174174}
175175
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-
214176static bool is_dio_a0_op_done = false ;
215177void TC6_Dio_A0_Callback (TC6_t *pInst, bool success, uint32_t addr, uint32_t value, void *pTag, void *pGlobalTag)
216178{
0 commit comments