diff --git a/master/sync.c b/master/sync.c index 0d968d17a311b5843bacbeb0692ebcec3aa6c6bb..e0fc12739bdcca2895e9afe3050c15328b882a48 100644 --- a/master/sync.c +++ b/master/sync.c @@ -195,3 +195,26 @@ void ec_sync_clear_pdos( } /*****************************************************************************/ + +/** + */ + +ec_pdo_type_t ec_sync_get_pdo_type( + const ec_sync_t *sync /**< EtherCAT sync manager */ + ) +{ + int index = sync->index; + + if (sync->slave && sync->slave->sii_mailbox_protocols) { + index -= 2; + } + + if (index < 0 || index > 1) { + EC_WARN("ec_sync_get_pdo_type(): invalid sync manager index.\n"); + return EC_RX_PDO; + } + + return (ec_pdo_type_t) index; +} + +/*****************************************************************************/ diff --git a/master/sync.h b/master/sync.h index 11255a997c0260bdc3db3ea09cad39e3f374a78f..fca77151c9093f116eebfef41e9eaa092495a014 100644 --- a/master/sync.h +++ b/master/sync.h @@ -83,6 +83,8 @@ void ec_sync_config(const ec_sync_t *, uint8_t *); int ec_sync_add_pdo(ec_sync_t *, const ec_pdo_t *); void ec_sync_clear_pdos(ec_sync_t *); +ec_pdo_type_t ec_sync_get_pdo_type(const ec_sync_t *); + /*****************************************************************************/ #endif