/* Listener client attaches to a stream
*/
bool openavbEptSrvrAttachStream(int h,
AVBStreamID_t *streamID,
openavbSrpLsnrDeclSubtype_t ld)
{
openavbRC rc = OPENAVB_SUCCESS;
static U8 emptyMAC[ETH_ALEN] = { 0, 0, 0, 0, 0, 0 };
static AVBTSpec_t emptytSpec = {0, 0};
AVB_TRACE_ENTRY(AVB_TRACE_ENDPOINT);
clientStream_t *ps = findStream(streamID);
if (ps && ps->clientHandle != h) {
AVB_LOGF_ERROR("Error attaching listener: multiple clients for stream %d", streamID->uniqueID);
AVB_TRACE_EXIT(AVB_TRACE_ENDPOINT);
return FALSE;
}
if (!ps) {
ps = addStream(h, streamID);
if (!ps) {
AVB_LOGF_ERROR("Error attaching listener: unable to add client stream %d", streamID->uniqueID);
AVB_TRACE_EXIT(AVB_TRACE_ENDPOINT);
return FALSE;
}
ps->role = clientListener;
}
if(x_cfg.noSrp) {
// we are operating in a mode supporting preconfigured streams; SRP is not in use,
if(ld == openavbSrp_LDSt_Interest) {
// As a proxy for SRP, which would normally make this call after confirming
// availability of the stream, call the callback from here
strmRegCb((void*)ps, openavbSrp_AtTyp_TalkerAdvertise,
emptyMAC, // a flag to listener to read info from configuration file
&emptytSpec,
MAX_AVB_SR_CLASSES, // srClass - value doesn't matter because openavbEptSrvrNotifyLstnrOfSrpCb() throws it away
1, // accumLatency
NULL); // *failInfo
}
} else {
// Normal SRP Operation so pass to SRP
rc = openavbSrpAttachStream((void*)ps, streamID, ld);
if (!IS_OPENAVB_SUCCESS(rc))
delStream(ps);
}
openavbEndPtLogAllStaticStreams();
AVB_TRACE_EXIT(AVB_TRACE_ENDPOINT);
return IS_OPENAVB_SUCCESS(rc);
}
bool x_listenerDetach(clientStream_t *ps)
{
AVB_TRACE_ENTRY(AVB_TRACE_ENDPOINT);
openavbRC rc = OPENAVB_SUCCESS;
if(!x_cfg.noSrp) {
// Pass to SRP
rc = openavbSrpDetachStream(&ps->streamID);
}
// remove record
delStream(ps);
openavbEndPtLogAllStaticStreams();
AVB_TRACE_EXIT(AVB_TRACE_ENDPOINT);
return IS_OPENAVB_SUCCESS(rc);
}
/*************************************************************
*
* Internal function to cleanup streams
*
*/
bool x_talkerDeregister(clientStream_t *ps)
{
AVB_TRACE_ENTRY(AVB_TRACE_ENDPOINT);
openavbRC rc = OPENAVB_SUCCESS;
if(!x_cfg.noSrp) {
// Pass to SRP
rc = openavbSrpDeregisterStream(&ps->streamID);
}
// Remove QMgr entry for stream
if (ps->fwmark != INVALID_FWMARK) {
openavbQmgrRemoveStream(ps->fwmark);
ps->fwmark = INVALID_FWMARK;
}
// Release MAAP address allocation
if (ps->hndMaap) {
openavbMaapRelease(ps->hndMaap);
ps->hndMaap = NULL;
}
// Finish Shaping
if (ps->hndShaper) {
openavbShaperRelease(ps->hndShaper);
ps->hndShaper = NULL;
}
// remove record
delStream(ps);
openavbEndPtLogAllStaticStreams();
AVB_TRACE_EXIT(AVB_TRACE_ENDPOINT);
return IS_OPENAVB_SUCCESS(rc);
}
/* Talker client registers a stream
*/
bool openavbEptSrvrRegisterStream(int h,
AVBStreamID_t *streamID,
U8 destAddr[],
AVBTSpec_t *tSpec,
U8 srClass,
U8 srRank,
U32 latency)
{
openavbRC rc = OPENAVB_SUCCESS;
AVB_TRACE_ENTRY(AVB_TRACE_ENDPOINT);
clientStream_t *ps = findStream(streamID);
if (ps && ps->clientHandle != h) {
AVB_LOGF_ERROR("Error registering talker; multiple clients for stream %d", streamID->uniqueID);
AVB_TRACE_EXIT(AVB_TRACE_ENDPOINT);
return FALSE;
}
ps = addStream(h, streamID);
if (!ps) {
AVB_LOGF_ERROR("Error registering talker; unable to add client stream %d", streamID->uniqueID);
AVB_TRACE_EXIT(AVB_TRACE_ENDPOINT);
return FALSE;
}
ps->role = clientTalker;
ps->tSpec = *tSpec;
ps->srClass = (SRClassIdx_t)srClass;
ps->srRank = srRank;
ps->latency = latency;
ps->fwmark = INVALID_FWMARK;
if (memcmp(ps->destAddr, destAddr, ETH_ALEN) == 0) {
// no client-supplied address, use MAAP
struct ether_addr addr;
ps->hndMaap = openavbMaapAllocate(1, &addr);
if (ps->hndMaap) {
memcpy(ps->destAddr, addr.ether_addr_octet, ETH_ALEN);
strmAttachCb((void*)ps, openavbSrp_LDSt_Stream_Info); // Inform talker about MAAP
}
else {
AVB_LOG_ERROR("Error registering talker: MAAP failed to allocate MAC address");
AVB_TRACE_EXIT(AVB_TRACE_ENDPOINT);
delStream(ps);
return FALSE;
}
}
else {
// client-supplied destination MAC address
memcpy(ps->destAddr, destAddr, ETH_ALEN);
ps->hndMaap = NULL;
}
// Do SRP talker register
AVB_LOGF_DEBUG("REGISTER: ps=%p, streamID=%d, tspec=%d,%d, srClass=%d, srRank=%d, latency=%d, da="ETH_FORMAT"",
ps, streamID->uniqueID,
tSpec->maxFrameSize, tSpec->maxIntervalFrames,
ps->srClass, ps->srRank, ps->latency,
ETH_OCTETS(ps->destAddr));
if(x_cfg.noSrp) {
// we are operating in a mode supporting preconfigured streams; SRP is not in use,
// so, as a proxy for SRP, which would normally make this call after establishing
// the stream, call the callback from here
strmAttachCb((void*)ps, openavbSrp_LDSt_Ready);
} else {
// normal SRP operation
rc = openavbSrpRegisterStream((void*)ps, &ps->streamID,
ps->destAddr, &ps->tSpec,
ps->srClass, ps->srRank,
ps->latency);
if (!IS_OPENAVB_SUCCESS(rc)) {
if (ps->hndMaap)
openavbMaapRelease(ps->hndMaap);
delStream(ps);
}
}
openavbEndPtLogAllStaticStreams();
AVB_TRACE_EXIT(AVB_TRACE_ENDPOINT);
return IS_OPENAVB_SUCCESS(rc);
}
