equal
deleted
inserted
replaced
485 |
485 |
486 static void sendPdo(CO_Data * d, UNS32 pdoNum, Message * pdo) |
486 static void sendPdo(CO_Data * d, UNS32 pdoNum, Message * pdo) |
487 { |
487 { |
488 /*store_as_last_message */ |
488 /*store_as_last_message */ |
489 d->PDO_status[pdoNum].last_message = *pdo; |
489 d->PDO_status[pdoNum].last_message = *pdo; |
490 MSG_WAR (0x396D, "sendPDO cobId :", UNS16_LE(pdo->cob_id)); |
490 MSG_WAR (0x396D, "sendPDO cobId :", UNS16_LE(pdo.cob_id)); |
491 MSG_WAR (0x396E, " Nb octets : ", pdo->len); |
491 MSG_WAR (0x396E, " Nb octets : ", pdo.len); |
492 |
492 |
493 canSend (d->canHandle, pdo); |
493 canSend (d->canHandle, pdo); |
494 } |
494 } |
495 |
495 |
496 |
496 |
510 } |
510 } |
511 |
511 |
512 UNS8 |
512 UNS8 |
513 sendOnePDOevent (CO_Data * d, UNS32 pdoNum) |
513 sendOnePDOevent (CO_Data * d, UNS32 pdoNum) |
514 { |
514 { |
|
515 UNS16 offsetObjdict; |
|
516 Message pdo; |
515 if (!d->CurrentCommunicationState.csPDO || |
517 if (!d->CurrentCommunicationState.csPDO || |
516 (d->PDO_status[pdoNum].transmit_type_parameter & PDO_INHIBITED)) |
518 !(d->PDO_status[pdoNum].transmit_type_parameter & PDO_INHIBITED)) |
517 { |
519 { |
518 return 0; |
520 return 0; |
519 } |
521 } |
520 |
522 |
521 UNS16 offsetObjdict = d->firstIndex->PDO_TRS + pdoNum; |
523 offsetObjdict = d->firstIndex->PDO_TRS + pdoNum; |
522 MSG_WAR (0x3968, " PDO is on EVENT. Trans type : ", |
524 MSG_WAR (0x3968, " PDO is on EVENT. Trans type : ", |
523 *pTransmissionType); |
525 *pTransmissionType); |
524 Message pdo; |
526 |
525 memset(&pdo, 0, sizeof(pdo)); |
527 memset(&pdo, 0, sizeof(pdo)); |
526 if (buildPDO (d, pdoNum, &pdo)) |
528 if (buildPDO (d, pdoNum, &pdo)) |
527 { |
529 { |
528 MSG_ERR (0x3907, " Couldn't build TPDO number : ", |
530 MSG_ERR (0x3907, " Couldn't build TPDO number : ", |
529 pdoNum); |
531 pdoNum); |