src/states.c
changeset 152 5e14844e5756
parent 149 fe50ada8020b
child 178 01d81faa3350
equal deleted inserted replaced
151:ebf4bd44f282 152:5e14844e5756
   182     UNS8 i = 0;
   182     UNS8 i = 0;
   183     UNS16 offset = d->firstIndex->PDO_RCV;
   183     UNS16 offset = d->firstIndex->PDO_RCV;
   184     UNS16 lastIndex = d->lastIndex->PDO_RCV;
   184     UNS16 lastIndex = d->lastIndex->PDO_RCV;
   185     UNS32 cobID[] = {0x200, 0x300, 0x400, 0x500};
   185     UNS32 cobID[] = {0x200, 0x300, 0x400, 0x500};
   186     if( offset ) while( (offset <= lastIndex) && (i < 4)) {
   186     if( offset ) while( (offset <= lastIndex) && (i < 4)) {
   187       if(*(UNS32*)d->objdict[offset].pSubindex[1].pObject == cobID[i] + *d->bDeviceNodeId)
   187       //if(*(UNS32*)d->objdict[offset].pSubindex[1].pObject == cobID[i] + *d->bDeviceNodeId)
   188 	      *(UNS32*)d->objdict[offset].pSubindex[1].pObject = cobID[i] + nodeId;
   188 	      *(UNS32*)d->objdict[offset].pSubindex[1].pObject = cobID[i] + nodeId;
   189       i ++;
   189       i ++;
   190       offset ++;
   190       offset ++;
   191     }
   191     }
   192   }
   192   }
   196     UNS16 offset = d->firstIndex->PDO_TRS;
   196     UNS16 offset = d->firstIndex->PDO_TRS;
   197     UNS16 lastIndex = d->lastIndex->PDO_TRS;
   197     UNS16 lastIndex = d->lastIndex->PDO_TRS;
   198     UNS32 cobID[] = {0x180, 0x280, 0x380, 0x480};
   198     UNS32 cobID[] = {0x180, 0x280, 0x380, 0x480};
   199     i = 0;
   199     i = 0;
   200     if( offset ) while ((offset <= lastIndex) && (i < 4)) {
   200     if( offset ) while ((offset <= lastIndex) && (i < 4)) {
   201       if(*(UNS32*)d->objdict[offset].pSubindex[1].pObject == cobID[i] + *d->bDeviceNodeId)
   201       //if(*(UNS32*)d->objdict[offset].pSubindex[1].pObject == cobID[i] + *d->bDeviceNodeId)
   202 	      *(UNS32*)d->objdict[offset].pSubindex[1].pObject = cobID[i] + nodeId;
   202 	      *(UNS32*)d->objdict[offset].pSubindex[1].pObject = cobID[i] + nodeId;
   203       i ++;
   203       i ++;
   204       offset ++;
   204       offset ++;
   205     }
   205     }
   206   }
   206   }