src/states.c
changeset 517 003679edc437
parent 447 c9d01296d6d9
child 668 ba53613e94e4
equal deleted inserted replaced
516:19085e93ad21 517:003679edc437
   242 {
   242 {
   243   UNS16 offset = d->firstIndex->SDO_SVR;
   243   UNS16 offset = d->firstIndex->SDO_SVR;
   244   
   244   
   245 #ifdef CO_ENABLE_LSS
   245 #ifdef CO_ENABLE_LSS
   246   d->lss_transfer.nodeID=nodeId;
   246   d->lss_transfer.nodeID=nodeId;
   247   if(nodeId==0xFF)
   247   if(nodeId==0xFF){
   248   {
       
   249   	*d->bDeviceNodeId = nodeId;
   248   	*d->bDeviceNodeId = nodeId;
   250   	return;
   249   	return;
   251   }
   250   }
       
   251   else
   252 #endif
   252 #endif
       
   253   if(!(nodeId>0 && nodeId<=127)){
       
   254 	  MSG_WAR(0x2D01, "Invalid NodeID",nodeId);
       
   255 	  return;
       
   256   }
   253 
   257 
   254   if(offset){
   258   if(offset){
   255     /* Adjust COB-ID Client->Server (rx) only id already set to default value or id not valid (id==0xFF)*/
   259     /* Adjust COB-ID Client->Server (rx) only id already set to default value or id not valid (id==0xFF)*/
   256     if((*(UNS32*)d->objdict[offset].pSubindex[1].pObject == 0x600 + *d->bDeviceNodeId)||(*d->bDeviceNodeId==0xFF)){
   260     if((*(UNS32*)d->objdict[offset].pSubindex[1].pObject == 0x600 + *d->bDeviceNodeId)||(*d->bDeviceNodeId==0xFF)){
   257       /* cob_id_client = 0x600 + nodeId; */
   261       /* cob_id_client = 0x600 + nodeId; */