/* * Check that the header set works */ void HeaderSetTest::testHeaderSet() { HeaderSet headers; RootHeader root_header; E131Header e131_header("e131", 1, 2, 6001); E133Header e133_header("foo", 1, 2050); DMPHeader dmp_header(false, false, NON_RANGE, ONE_BYTES); // test the root header component CID cid = CID::Generate(); root_header.SetCid(cid); headers.SetRootHeader(root_header); OLA_ASSERT(root_header == headers.GetRootHeader()); // test the E1.31 header component headers.SetE131Header(e131_header); OLA_ASSERT(e131_header == headers.GetE131Header()); // test the E1.33 header component headers.SetE133Header(e133_header); OLA_ASSERT(e133_header == headers.GetE133Header()); // test the DMP headers component headers.SetDMPHeader(dmp_header); OLA_ASSERT(dmp_header == headers.GetDMPHeader()); // test assign HeaderSet headers2 = headers; OLA_ASSERT(root_header == headers2.GetRootHeader()); OLA_ASSERT(e131_header == headers2.GetE131Header()); OLA_ASSERT(e133_header == headers2.GetE133Header()); OLA_ASSERT(dmp_header == headers2.GetDMPHeader()); OLA_ASSERT(headers2 == headers); // test copy HeaderSet headers3(headers); OLA_ASSERT(root_header == headers3.GetRootHeader()); OLA_ASSERT(e131_header == headers3.GetE131Header()); OLA_ASSERT(e133_header == headers3.GetE133Header()); OLA_ASSERT(dmp_header == headers3.GetDMPHeader()); OLA_ASSERT(headers3 == headers); }
/* * Handle a DMP PDU for E1.31. */ bool DMPE131Inflator::HandlePDUData(uint32_t vector, const HeaderSet &headers, const uint8_t *data, unsigned int pdu_len) { if (vector != ola::acn::DMP_SET_PROPERTY_VECTOR) { OLA_INFO << "not a set property msg: " << vector; return true; } E131Header e131_header = headers.GetE131Header(); UniverseHandlers::iterator universe_iter = m_handlers.find(e131_header.Universe()); if (e131_header.PreviewData() && m_ignore_preview) { OLA_DEBUG << "Ignoring preview data"; return true; } if (universe_iter == m_handlers.end()) return true; DMPHeader dmp_header = headers.GetDMPHeader(); if (!dmp_header.IsVirtual() || dmp_header.IsRelative() || dmp_header.Size() != TWO_BYTES || dmp_header.Type() != RANGE_EQUAL) { OLA_INFO << "malformed E1.31 dmp header " << dmp_header.Header(); return true; } if (e131_header.Priority() > MAX_PRIORITY) { OLA_INFO << "Priority " << static_cast<int>(e131_header.Priority()) << " is greater than the max priority (" << static_cast<int>(MAX_PRIORITY) << "), ignoring data"; return true; } unsigned int available_length = pdu_len; std::auto_ptr<const BaseDMPAddress> address( DecodeAddress(dmp_header.Size(), dmp_header.Type(), data, &available_length)); if (!address.get()) { OLA_INFO << "DMP address parsing failed, the length is probably too small"; return true; } if (address->Increment() != 1) { OLA_INFO << "E1.31 DMP packet with increment " << address->Increment() << ", disarding"; return true; } unsigned int length_remaining = pdu_len - available_length; int start_code = -1; if (e131_header.UsingRev2()) start_code = static_cast<int>(address->Start()); else if (length_remaining && address->Number()) start_code = *(data + available_length); // The only time we want to continue processing a non-0 start code is if it // contains a Terminate message. if (start_code && !e131_header.StreamTerminated()) { OLA_INFO << "Skipping packet with non-0 start code: " << start_code; return true; } DmxBuffer *target_buffer; if (!TrackSourceIfRequired(&universe_iter->second, headers, &target_buffer)) { // no need to continue processing return true; } // Reaching here means that we actually have new data and we should merge. if (target_buffer && start_code == 0) { unsigned int channels = std::min(length_remaining, address->Number()); if (e131_header.UsingRev2()) target_buffer->Set(data + available_length, channels); else target_buffer->Set(data + available_length + 1, channels - 1); } if (universe_iter->second.priority) *universe_iter->second.priority = universe_iter->second.active_priority; // merge the sources switch (universe_iter->second.sources.size()) { case 0: universe_iter->second.buffer->Reset(); break; case 1: universe_iter->second.buffer->Set( universe_iter->second.sources[0].buffer); universe_iter->second.closure->Run(); break; default: // HTP Merge universe_iter->second.buffer->Reset(); std::vector<dmx_source>::const_iterator source_iter = universe_iter->second.sources.begin(); for (; source_iter != universe_iter->second.sources.end(); ++source_iter) universe_iter->second.buffer->HTPMerge(source_iter->buffer); universe_iter->second.closure->Run(); } return true; }
/* * Check if this source is operating at the highest priority for this universe. * This takes care of tracking all sources for a universe at the active * priority. * @param universe_data the universe_handler struct for this universe, * @param HeaderSet the set of headers in this packet * @param buffer, if set to a non-NULL pointer, the caller should copy the data * in the buffer. * @returns true if we should remerge the data, false otherwise. */ bool DMPE131Inflator::TrackSourceIfRequired( universe_handler *universe_data, const HeaderSet &headers, DmxBuffer **buffer) { *buffer = NULL; // default the buffer to NULL ola::TimeStamp now; m_clock.CurrentTime(&now); const E131Header &e131_header = headers.GetE131Header(); uint8_t priority = e131_header.Priority(); vector<dmx_source> &sources = universe_data->sources; vector<dmx_source>::iterator iter = sources.begin(); while (iter != sources.end()) { if (iter->cid != headers.GetRootHeader().GetCid()) { TimeStamp expiry_time = iter->last_heard_from + EXPIRY_INTERVAL; if (now > expiry_time) { OLA_INFO << "source " << iter->cid.ToString() << " has expired"; iter = sources.erase(iter); continue; } } iter++; } if (sources.empty()) universe_data->active_priority = 0; for (iter = sources.begin(); iter != sources.end(); ++iter) { if (iter->cid == headers.GetRootHeader().GetCid()) break; } if (iter == sources.end()) { // This is an untracked source if (e131_header.StreamTerminated() || priority < universe_data->active_priority) return false; if (priority > universe_data->active_priority) { OLA_INFO << "Raising priority for universe " << e131_header.Universe() << " from " << static_cast<int>(universe_data->active_priority) << " to " << static_cast<int>(priority); sources.clear(); universe_data->active_priority = priority; } if (sources.size() == MAX_MERGE_SOURCES) { // TODO(simon): flag this in the export map OLA_WARN << "Max merge sources reached for universe " << e131_header.Universe() << ", " << headers.GetRootHeader().GetCid().ToString() << " won't be tracked"; return false; } else { OLA_INFO << "Added new E1.31 source: " << headers.GetRootHeader().GetCid().ToString(); dmx_source new_source; new_source.cid = headers.GetRootHeader().GetCid(); new_source.sequence = e131_header.Sequence(); new_source.last_heard_from = now; iter = sources.insert(sources.end(), new_source); *buffer = &iter->buffer; return true; } } else { // We already know about this one, check the seq # int8_t seq_diff = static_cast<int8_t>(e131_header.Sequence() - iter->sequence); if (seq_diff <= 0 && seq_diff > SEQUENCE_DIFF_THRESHOLD) { OLA_INFO << "Old packet received, ignoring, this # " << static_cast<int>(e131_header.Sequence()) << ", last " << static_cast<int>(iter->sequence); return false; } iter->sequence = e131_header.Sequence(); if (e131_header.StreamTerminated()) { OLA_INFO << "CID " << headers.GetRootHeader().GetCid().ToString() << " sent a termination for universe " << e131_header.Universe(); sources.erase(iter); if (sources.empty()) universe_data->active_priority = 0; // We need to trigger a merge here else the buffer will be stale, we keep // the buffer as NULL though so we don't use the data. return true; } iter->last_heard_from = now; if (priority < universe_data->active_priority) { if (sources.size() == 1) { universe_data->active_priority = priority; } else { sources.erase(iter); return true; } } else if (priority > universe_data->active_priority) { // new active priority universe_data->active_priority = priority; if (sources.size() != 1) { // clear all sources other than this one dmx_source this_source = *iter; sources.clear(); iter = sources.insert(sources.end(), this_source); } } *buffer = &iter->buffer; return true; } }