src/states.c
changeset 236 905677ed00f3
parent 235 f812bf6b7237
child 263 d221d387ad2f
equal deleted inserted replaced
235:f812bf6b7237 236:905677ed00f3
   256     UNS8 i = 0;
   256     UNS8 i = 0;
   257     UNS16 offset = d->firstIndex->PDO_RCV;
   257     UNS16 offset = d->firstIndex->PDO_RCV;
   258     UNS16 lastIndex = d->lastIndex->PDO_RCV;
   258     UNS16 lastIndex = d->lastIndex->PDO_RCV;
   259     UNS32 cobID[] = {0x200, 0x300, 0x400, 0x500};
   259     UNS32 cobID[] = {0x200, 0x300, 0x400, 0x500};
   260     if( offset ) while( (offset <= lastIndex) && (i < 4)) {
   260     if( offset ) while( (offset <= lastIndex) && (i < 4)) {
   261       //if(*(UNS32*)d->objdict[offset].pSubindex[1].pObject == cobID[i] + *d->bDeviceNodeId)
   261       if(*(UNS32*)d->objdict[offset].pSubindex[1].pObject == cobID[i] + *d->bDeviceNodeId)
   262 	      *(UNS32*)d->objdict[offset].pSubindex[1].pObject = cobID[i] + nodeId;
   262 	      *(UNS32*)d->objdict[offset].pSubindex[1].pObject = cobID[i] + nodeId;
   263       i ++;
   263       i ++;
   264       offset ++;
   264       offset ++;
   265     }
   265     }
   266   }
   266   }
   270     UNS16 offset = d->firstIndex->PDO_TRS;
   270     UNS16 offset = d->firstIndex->PDO_TRS;
   271     UNS16 lastIndex = d->lastIndex->PDO_TRS;
   271     UNS16 lastIndex = d->lastIndex->PDO_TRS;
   272     UNS32 cobID[] = {0x180, 0x280, 0x380, 0x480};
   272     UNS32 cobID[] = {0x180, 0x280, 0x380, 0x480};
   273     i = 0;
   273     i = 0;
   274     if( offset ) while ((offset <= lastIndex) && (i < 4)) {
   274     if( offset ) while ((offset <= lastIndex) && (i < 4)) {
   275       //if(*(UNS32*)d->objdict[offset].pSubindex[1].pObject == cobID[i] + *d->bDeviceNodeId)
   275       if(*(UNS32*)d->objdict[offset].pSubindex[1].pObject == cobID[i] + *d->bDeviceNodeId)
   276 	      *(UNS32*)d->objdict[offset].pSubindex[1].pObject = cobID[i] + nodeId;
   276 	      *(UNS32*)d->objdict[offset].pSubindex[1].pObject = cobID[i] + nodeId;
   277       i ++;
   277       i ++;
   278       offset ++;
   278       offset ++;
   279     }
   279     }
   280   }
   280   }