// This talker callback will be called for each AVB observation interval. tx_cb_ret_t openavbMapNullTxCB(media_q_t *pMediaQ, U8 *pData, U32 *dataLen) { AVB_TRACE_ENTRY(AVB_TRACE_MAP_DETAIL); if (pMediaQ && pData && dataLen) { U8 *pHdr = pData; pvt_data_t *pPvtData = pMediaQ->pPvtMapInfo; if (!pPvtData) { AVB_LOG_ERROR("Private mapping module data not allocated."); return TX_CB_RET_PACKET_NOT_READY; } media_q_item_t *pMediaQItem = openavbMediaQTailLock(pMediaQ, TRUE); if (pMediaQItem) { // PTP walltime already set in the interface module. Just add the max transit time. openavbAvtpTimeAddUSec(pMediaQItem->pAvtpTime, pPvtData->maxTransitUsec); // Set timestamp valid flag if (openavbAvtpTimeTimestampIsValid(pMediaQItem->pAvtpTime)) pHdr[HIDX_AVTP_HIDE7_TV1] |= 0x01; // Set else { pHdr[HIDX_AVTP_HIDE7_TV1] &= ~0x01; // Clear } // Set timestamp uncertain flag if (openavbAvtpTimeTimestampIsUncertain(pMediaQItem->pAvtpTime)) pHdr[HIDX_AVTP_HIDE7_TU1] |= 0x01; // Set else pHdr[HIDX_AVTP_HIDE7_TU1] &= ~0x01; // Clear *(U32 *)(&pHdr[HIDX_AVTP_TIMESPAMP32]) = htonl(openavbAvtpTimeGetAvtpTimestamp(pMediaQItem->pAvtpTime)); pHdr[HIDX_OPENAVB_FORMAT8] = MAP_NULL_OPENAVB_FORMAT; pHdr[HIDX_OPENAVB_RESERVEDA8] = 0x00; pHdr[HIDX_OPENAVB_RESERVEDB8] = 0x00; pHdr[HIDX_OPENAVB_RESERVEDC8] = 0x00; *(U32 *)(&pHdr[HIDX_OPENAVB_FORMAT_SPEC32]) = 0x00000000; *dataLen = TOTAL_HEADER_SIZE; // No data openavbMediaQTailPull(pMediaQ); AVB_TRACE_LINE(AVB_TRACE_MAP_LINE); AVB_TRACE_EXIT(AVB_TRACE_MAP_DETAIL); return TX_CB_RET_PACKET_READY; } else { AVB_TRACE_EXIT(AVB_TRACE_MAP_DETAIL); return TX_CB_RET_PACKET_NOT_READY; // Media queue empty } } AVB_TRACE_EXIT(AVB_TRACE_MAP_DETAIL); return TX_CB_RET_PACKET_NOT_READY; }
// This callback is called when acting as a listener. bool openavbIntfViewerRxCB(media_q_t *pMediaQ) { AVB_TRACE_ENTRY(AVB_TRACE_INTF_DETAIL); if (pMediaQ) { pvt_data_t *pPvtData = pMediaQ->pPvtIntfInfo; if (!pPvtData) { AVB_LOG_ERROR("Private interface module data not allocated."); return FALSE; } media_q_item_t *pMediaQItem = openavbMediaQTailLock(pMediaQ, pPvtData->ignoreTimestamp); if (pMediaQItem) { // The skip countdown allow the viewer modes to set a number of packets to ignore // after logging to reduce or eliminate the logging from affecting the stats. if (pPvtData->skipCountdown) pPvtData->skipCountdown--; if (pMediaQItem->dataLen && !pPvtData->skipCountdown) { pPvtData->servicedCount++; if (pPvtData->viewType == VIEWER_MODE_DETAIL) { U32 avtpTimestamp; U64 avtpTimestampTime; bool avtpTimestampValid; U32 nowTimestamp; U64 nowTimestampTime; bool nowTimestampValid; U64 nowTime; S32 lateNS = 0; U64 gapNS = 0; avtpTimestamp = openavbAvtpTimeGetAvtpTimestamp(pMediaQItem->pAvtpTime); avtpTimestampTime = openavbAvtpTimeGetAvtpTimeNS(pMediaQItem->pAvtpTime); avtpTimestampValid = openavbAvtpTimeTimestampIsValid(pMediaQItem->pAvtpTime); openavbAvtpTimeSetToWallTime(pMediaQItem->pAvtpTime); nowTimestamp = openavbAvtpTimeGetAvtpTimestamp(pMediaQItem->pAvtpTime); nowTimestampTime = openavbAvtpTimeGetAvtpTimeNS(pMediaQItem->pAvtpTime); nowTimestampValid = openavbAvtpTimeTimestampIsValid(pMediaQItem->pAvtpTime); CLOCK_GETTIME64(OPENAVB_CLOCK_REALTIME, &nowTime); if (avtpTimestampValid && nowTimestampValid) { lateNS = nowTimestampTime - avtpTimestampTime; if (lateNS > pPvtData->maxLateNS) { pPvtData->maxLateNS = lateNS; } pPvtData->accumLateNS += lateNS; if (pPvtData->servicedCount > 1) { gapNS = nowTime - pPvtData->prevNowTime; if (gapNS > pPvtData->maxGapNS) { pPvtData->maxGapNS = gapNS; } pPvtData->accumGapNS += gapNS; } pPvtData->prevNowTime = nowTime; if ((pPvtData->servicedCount % pPvtData->viewInterval) == 0) { S32 lateAvg = pPvtData->accumLateNS / pPvtData->servicedCount; S32 gapAvg = pPvtData->accumGapNS / (pPvtData->servicedCount - 1); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, LOG_RT_END, "****************************", LOG_RT_DATATYPE_CONST_STR, NULL); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, LOG_RT_END, "Packets: %u", LOG_RT_DATATYPE_U32, &pPvtData->servicedCount); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, LOG_RT_END, "AVTP Timestamp: %u NS", LOG_RT_DATATYPE_U32, &avtpTimestamp); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, LOG_RT_END, "Now Timestamp: %u NS", LOG_RT_DATATYPE_U32, &nowTimestamp); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, LOG_RT_END, "Late: %d NS", LOG_RT_DATATYPE_S32, &lateNS); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, LOG_RT_END, "Late Avg: %d NS", LOG_RT_DATATYPE_S32, &lateAvg); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, LOG_RT_END, "Late Max: %d NS", LOG_RT_DATATYPE_S32, &pPvtData->maxLateNS); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, LOG_RT_END, "Gap: %u NS", LOG_RT_DATATYPE_U32, &gapNS); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, LOG_RT_END, "Gap Avg: %u NS", LOG_RT_DATATYPE_U32, &gapAvg); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, LOG_RT_END, "Gap Max: %u NS", LOG_RT_DATATYPE_U32, &pPvtData->maxGapNS); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, LOG_RT_END, "Data length: %u", LOG_RT_DATATYPE_U32, &pMediaQItem->dataLen); pPvtData->accumLateNS = 0; pPvtData->maxLateNS = 0; pPvtData->accumGapNS = 0; pPvtData->maxGapNS = 0; pPvtData->prevNowTime = 0; pPvtData->servicedCount = 0; pPvtData->skipCountdown = 10; } } } else if (pPvtData->viewType == VIEWER_MODE_MAPPING_AWARE) { } else if (pPvtData->viewType == VIEWER_MODE_AVTP_TIMESTAMP) { U64 avtpTimestampTime; bool avtpTimestampValid; S32 deltaNS = 0; avtpTimestampTime = openavbAvtpTimeGetAvtpTimeNS(pMediaQItem->pAvtpTime); avtpTimestampValid = openavbAvtpTimeTimestampIsValid(pMediaQItem->pAvtpTime); if (avtpTimestampValid) { if (pPvtData->servicedCount > 1) { deltaNS = avtpTimestampTime - pPvtData->prevAvtpTimestampTime; if (deltaNS > pPvtData->maxAvtpDeltaNS) { pPvtData->maxAvtpDeltaNS = deltaNS; } pPvtData->accumAvtpDeltaNS += deltaNS; if (pPvtData->avgForJitter != 0) { S32 deltaJitter = pPvtData->avgForJitter - deltaNS; if (deltaJitter < 0) deltaJitter = -deltaJitter; pPvtData->jitter += (1.0/16.0) * ((float)deltaJitter - pPvtData->jitter); } } pPvtData->prevAvtpTimestampTime = avtpTimestampTime; if ((pPvtData->servicedCount % pPvtData->viewInterval) == 0) { S32 deltaAvg = pPvtData->accumAvtpDeltaNS / (pPvtData->servicedCount - 1); U32 jitter = (U32)(pPvtData->jitter); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, FALSE, "AVTP Timestamp Delta: %d NS ", LOG_RT_DATATYPE_S32, &deltaNS); AVB_LOGRT_INFO(FALSE, LOG_RT_ITEM, FALSE, "AVTP Timestamp Delta Avg: %d NS ", LOG_RT_DATATYPE_S32, &deltaAvg); AVB_LOGRT_INFO(FALSE, LOG_RT_ITEM, FALSE, "AVTP Timestamp Delta Max: %d NS ", LOG_RT_DATATYPE_S32, &pPvtData->maxAvtpDeltaNS); AVB_LOGRT_INFO(FALSE, LOG_RT_ITEM, LOG_RT_END, "Jitter: %d", LOG_RT_DATATYPE_S32, &jitter); pPvtData->accumAvtpDeltaNS = 0; pPvtData->maxAvtpDeltaNS = 0; pPvtData->servicedCount = 0; pPvtData->prevAvtpTimestampTime = 0; pPvtData->skipCountdown = 10; pPvtData->jitter = 0.0; pPvtData->avgForJitter = deltaAvg; } } } else if (pPvtData->viewType == VIEWER_MODE_LATENCY) { U64 avtpTimestampTime; bool avtpTimestampValid; U64 nowTimestampTime; bool nowTimestampValid; S32 lateNS = 0; avtpTimestampTime = openavbAvtpTimeGetAvtpTimeNS(pMediaQItem->pAvtpTime); avtpTimestampValid = openavbAvtpTimeTimestampIsValid(pMediaQItem->pAvtpTime); openavbAvtpTimeSetToWallTime(pMediaQItem->pAvtpTime); nowTimestampTime = openavbAvtpTimeGetAvtpTimeNS(pMediaQItem->pAvtpTime); nowTimestampValid = openavbAvtpTimeTimestampIsValid(pMediaQItem->pAvtpTime); if (avtpTimestampValid && nowTimestampValid) { lateNS = nowTimestampTime - avtpTimestampTime; if (lateNS > pPvtData->maxLateNS) { pPvtData->maxLateNS = lateNS; } pPvtData->accumLateNS += lateNS; if (pPvtData->avgForJitter != 0) { S32 lateJitter = pPvtData->avgForJitter - lateNS; if (lateJitter < 0) lateJitter = -lateJitter; pPvtData->jitter += (1.0/16.0) * ((float)lateJitter - pPvtData->jitter); } if ((pPvtData->servicedCount % pPvtData->viewInterval) == 0) { S32 lateAvg = pPvtData->accumLateNS / pPvtData->servicedCount; U32 jitter = (U32)(pPvtData->jitter); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, FALSE, "Latency: %d NS ", LOG_RT_DATATYPE_S32, &lateNS); AVB_LOGRT_INFO(FALSE, LOG_RT_ITEM, FALSE, "Latency Avg: %d NS ", LOG_RT_DATATYPE_S32, &lateAvg); AVB_LOGRT_INFO(FALSE, LOG_RT_ITEM, FALSE, "Latency Max: %d NS ", LOG_RT_DATATYPE_S32, &pPvtData->maxLateNS); AVB_LOGRT_INFO(FALSE, LOG_RT_ITEM, LOG_RT_END, "Jitter: %d", LOG_RT_DATATYPE_S32, &jitter); pPvtData->accumLateNS = 0; pPvtData->maxLateNS = 0; pPvtData->servicedCount = 0; pPvtData->skipCountdown = 10; pPvtData->jitter = 0.0; pPvtData->avgForJitter = lateAvg; } } } else if (pPvtData->viewType == VIEWER_MODE_SELECTIVE_TIMESTAMP) { } else if (pPvtData->viewType == VIEWER_MODE_LATE) { U64 avtpTimestampTime; bool avtpTimestampValid; U64 nowTimestampTime; bool nowTimestampValid; S32 lateNS = 0; avtpTimestampTime = openavbAvtpTimeGetAvtpTimeNS(pMediaQItem->pAvtpTime); avtpTimestampValid = openavbAvtpTimeTimestampIsValid(pMediaQItem->pAvtpTime); openavbAvtpTimeSetToWallTime(pMediaQItem->pAvtpTime); nowTimestampTime = openavbAvtpTimeGetAvtpTimeNS(pMediaQItem->pAvtpTime); nowTimestampValid = openavbAvtpTimeTimestampIsValid(pMediaQItem->pAvtpTime); if (avtpTimestampValid && nowTimestampValid) { lateNS = nowTimestampTime - avtpTimestampTime; if (lateNS > pPvtData->maxLateNS) { pPvtData->maxLateNS = lateNS; } pPvtData->accumLateNS += lateNS; if (pPvtData->avgForJitter != 0) { S32 lateJitter = pPvtData->avgForJitter - lateNS; if (lateJitter < 0) lateJitter = -lateJitter; pPvtData->jitter += (1.0/16.0) * ((float)lateJitter - pPvtData->jitter); } if ((pPvtData->servicedCount % pPvtData->viewInterval) == 0) { S32 lateAvg = pPvtData->accumLateNS / pPvtData->servicedCount; U32 jitter = (U32)(pPvtData->jitter); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, FALSE, "Late: %d NS ", LOG_RT_DATATYPE_S32, &lateNS); AVB_LOGRT_INFO(FALSE, LOG_RT_ITEM, FALSE, "Late Avg: %d NS ", LOG_RT_DATATYPE_S32, &lateAvg); AVB_LOGRT_INFO(FALSE, LOG_RT_ITEM, FALSE, "Late Max: %d NS ", LOG_RT_DATATYPE_S32, &pPvtData->maxLateNS); AVB_LOGRT_INFO(FALSE, LOG_RT_ITEM, LOG_RT_END, "Jitter: %d", LOG_RT_DATATYPE_S32, &jitter); pPvtData->accumLateNS = 0; pPvtData->maxLateNS = 0; pPvtData->servicedCount = 0; pPvtData->skipCountdown = 10; pPvtData->jitter = 0.0; pPvtData->avgForJitter = lateAvg; } } } else if (pPvtData->viewType == VIEWER_MODE_GAP) { U64 nowTime; U64 gapNS = 0; CLOCK_GETTIME64(OPENAVB_CLOCK_REALTIME, &nowTime); if (pPvtData->servicedCount > 1) { gapNS = nowTime - pPvtData->prevNowTime; if (gapNS > pPvtData->maxGapNS) { pPvtData->maxGapNS = gapNS; } pPvtData->accumGapNS += gapNS; if (pPvtData->avgForJitter != 0) { S32 gapJitter = pPvtData->avgForJitter - gapNS; if (gapJitter < 0) gapJitter = -gapJitter; pPvtData->jitter += (1.0/16.0) * ((float)gapJitter - pPvtData->jitter); } } pPvtData->prevNowTime = nowTime; if ((pPvtData->servicedCount % pPvtData->viewInterval) == 0) { S32 gapAvg = pPvtData->accumGapNS / (pPvtData->servicedCount - 1); U32 jitter = (U32)(pPvtData->jitter); AVB_LOGRT_INFO(LOG_RT_BEGIN, LOG_RT_ITEM, FALSE, "Gap: %d NS ", LOG_RT_DATATYPE_S32, &gapNS); AVB_LOGRT_INFO(FALSE, LOG_RT_ITEM, FALSE, "Gap Avg: %d NS ", LOG_RT_DATATYPE_S32, &gapAvg); AVB_LOGRT_INFO(FALSE, LOG_RT_ITEM, FALSE, "Gap Max: %d NS ", LOG_RT_DATATYPE_S32, &pPvtData->maxGapNS); AVB_LOGRT_INFO(FALSE, LOG_RT_ITEM, LOG_RT_END, "Jitter: %d", LOG_RT_DATATYPE_S32, &jitter); pPvtData->accumGapNS = 0; pPvtData->maxGapNS = 0; pPvtData->prevNowTime = 0; pPvtData->servicedCount = 0; pPvtData->skipCountdown = 10; pPvtData->jitter = 0.0; pPvtData->avgForJitter = gapAvg; } } } openavbMediaQTailPull(pMediaQ); } } AVB_TRACE_EXIT(AVB_TRACE_INTF_DETAIL); return TRUE; }