2021-05-27 10:59:22 -04:00
|
|
|
/*
|
|
|
|
dmp.cpp
|
|
|
|
|
|
|
|
Copyright (c) 2020 Kevin Matz (kevin.matz@gmail.com)
|
|
|
|
|
|
|
|
Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
|
|
of this software and associated documentation files (the "Software"), to deal
|
|
|
|
in the Software without restriction, including without limitation the rights
|
|
|
|
to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
|
|
copies of the Software, and to permit persons to whom the Software is
|
|
|
|
furnished to do so, subject to the following conditions:
|
|
|
|
|
|
|
|
The above copyright notice and this permission notice shall be included in all
|
|
|
|
copies or substantial portions of the Software.
|
|
|
|
|
|
|
|
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
|
|
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
|
|
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
|
|
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
|
|
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
|
|
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
|
|
|
SOFTWARE.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include "dmp.h"
|
|
|
|
|
2021-08-24 18:10:20 -04:00
|
|
|
namespace ACN::DMP {
|
2021-05-27 10:59:22 -04:00
|
|
|
|
2021-07-26 21:15:48 -04:00
|
|
|
/**
|
2021-08-15 21:43:36 -04:00
|
|
|
* @brief range::read_
|
|
|
|
* @param stream
|
|
|
|
* @param length
|
2021-07-29 19:26:49 -04:00
|
|
|
* @return
|
2021-07-26 21:15:48 -04:00
|
|
|
*/
|
2021-08-15 21:43:36 -04:00
|
|
|
uint32_t range::read_(PDU::Stream stream)
|
2021-07-26 21:15:48 -04:00
|
|
|
{
|
2021-08-31 09:01:57 -04:00
|
|
|
switch (type_.address_length) {
|
2021-08-15 21:43:36 -04:00
|
|
|
case ONE:
|
|
|
|
return stream->readType<uint8_t>();
|
|
|
|
case TWO:
|
|
|
|
return stream->readType<uint16_t>();
|
|
|
|
case FOUR:
|
|
|
|
return stream->readType<uint32_t>();
|
|
|
|
default:
|
|
|
|
return 0;
|
|
|
|
}
|
2021-05-27 10:59:22 -04:00
|
|
|
}
|
|
|
|
|
2021-07-26 21:15:48 -04:00
|
|
|
|
2021-07-29 11:20:03 -04:00
|
|
|
/**
|
2021-08-15 21:43:36 -04:00
|
|
|
* @brief range::write_
|
2021-07-29 19:26:49 -04:00
|
|
|
* @param stream
|
2021-08-15 21:43:36 -04:00
|
|
|
* @param val
|
2021-07-29 11:20:03 -04:00
|
|
|
*/
|
2021-08-15 21:43:36 -04:00
|
|
|
void range::write_(PDU::Stream stream, const uint32_t& val) const
|
|
|
|
{
|
2021-08-31 09:01:57 -04:00
|
|
|
switch (type_.address_length) {
|
2021-08-15 21:43:36 -04:00
|
|
|
case ONE:
|
2021-09-01 12:21:22 -04:00
|
|
|
*stream << static_cast<uint8_t>(val);
|
|
|
|
break;
|
2021-08-15 21:43:36 -04:00
|
|
|
case TWO:
|
2021-09-01 12:21:22 -04:00
|
|
|
*stream << static_cast<uint16_t>(val);
|
|
|
|
break;
|
2021-08-15 21:43:36 -04:00
|
|
|
case FOUR:
|
2021-09-01 12:21:22 -04:00
|
|
|
*stream << val;
|
|
|
|
break;
|
2021-08-15 21:43:36 -04:00
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
size_t range::streamSize() const
|
2021-07-29 11:20:03 -04:00
|
|
|
{
|
2021-09-01 12:22:53 -04:00
|
|
|
auto count = [&] () {
|
2021-08-31 09:01:57 -04:00
|
|
|
switch (type_.data_type) {
|
2021-08-15 21:43:36 -04:00
|
|
|
case SINGLE:
|
|
|
|
return 1;
|
|
|
|
default:
|
|
|
|
return 3;
|
|
|
|
}
|
|
|
|
};
|
2021-09-01 12:22:53 -04:00
|
|
|
|
|
|
|
auto width = [&] () {
|
|
|
|
switch (type_.address_length) {
|
|
|
|
case ZERO: return 0;
|
|
|
|
case ONE: return 1;
|
|
|
|
case TWO: return 2;
|
|
|
|
case FOUR: return 4;
|
|
|
|
}
|
|
|
|
};
|
|
|
|
|
|
|
|
return count() * width();
|
2021-07-29 11:20:03 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
2021-08-15 21:43:36 -04:00
|
|
|
* @brief range::iStream
|
|
|
|
* @param stream
|
2021-07-29 11:20:03 -04:00
|
|
|
*/
|
2021-08-15 21:43:36 -04:00
|
|
|
void range::iStream(PDU::Stream stream)
|
2021-07-29 11:20:03 -04:00
|
|
|
{
|
2021-08-16 10:14:39 -04:00
|
|
|
address = read_(stream);
|
2021-09-01 12:22:53 -04:00
|
|
|
if (type_.data_type == SINGLE)
|
|
|
|
return;
|
2021-08-16 10:14:39 -04:00
|
|
|
incriment = read_(stream);
|
|
|
|
count = read_(stream);
|
2021-07-29 11:20:03 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2021-07-26 21:15:48 -04:00
|
|
|
/**
|
2021-08-15 21:43:36 -04:00
|
|
|
* @brief range::oStream
|
2021-07-26 21:15:48 -04:00
|
|
|
* @param stream
|
|
|
|
*/
|
2021-08-15 21:43:36 -04:00
|
|
|
void range::oStream(PDU::Stream stream) const
|
2021-05-27 15:35:28 -04:00
|
|
|
{
|
2021-08-15 21:43:36 -04:00
|
|
|
write_(stream, address);
|
2021-09-01 12:22:53 -04:00
|
|
|
if (type_.data_type == SINGLE)
|
|
|
|
return;
|
2021-08-15 21:43:36 -04:00
|
|
|
write_(stream, incriment);
|
|
|
|
write_(stream, count);
|
2021-05-27 10:59:22 -04:00
|
|
|
}
|
|
|
|
|
2021-07-26 21:15:48 -04:00
|
|
|
|
|
|
|
/**
|
2021-08-15 21:43:36 -04:00
|
|
|
* @brief dmp_set_data::streamSize
|
2021-07-26 21:15:48 -04:00
|
|
|
* @return
|
|
|
|
*/
|
2021-08-15 21:43:36 -04:00
|
|
|
size_t address_pair_list::streamSize() const
|
2021-07-26 21:15:48 -04:00
|
|
|
{
|
2021-08-15 21:43:36 -04:00
|
|
|
size_t s = 0;
|
|
|
|
for (const auto & [range, vect] : properties)
|
|
|
|
{
|
|
|
|
s += range.streamSize();
|
|
|
|
s += vect.size();
|
|
|
|
}
|
|
|
|
return s;
|
2021-05-27 10:59:22 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2021-07-29 11:20:03 -04:00
|
|
|
/**
|
2021-08-25 17:20:33 -04:00
|
|
|
* @brief address_pair_list::iStream
|
|
|
|
* @param stream
|
2021-08-15 21:43:36 -04:00
|
|
|
*/
|
|
|
|
void address_pair_list::iStream(PDU::Stream stream)
|
|
|
|
{
|
|
|
|
while(stream->good()) {
|
|
|
|
// Property Address
|
2021-08-31 09:01:57 -04:00
|
|
|
range pr(type_);
|
2021-08-15 21:43:36 -04:00
|
|
|
pr.iStream(stream);
|
|
|
|
|
2021-08-29 11:06:00 -04:00
|
|
|
if (!stream->good() || stream->available() < pr.count * pr.incriment)
|
|
|
|
return stream->setstate(std::ios_base::failbit);
|
2021-08-15 21:43:36 -04:00
|
|
|
|
|
|
|
// Property Data
|
|
|
|
std::vector<uint8_t> pd;
|
2021-08-29 11:06:00 -04:00
|
|
|
std::copy(stream->data(), stream->data() + pr.count * pr.incriment,
|
|
|
|
std::back_inserter(pd));
|
|
|
|
stream->ignore(pd.size());
|
|
|
|
|
|
|
|
if (!stream->available())
|
|
|
|
stream->setstate(std::ios_base::eofbit);
|
2021-08-15 21:43:36 -04:00
|
|
|
|
|
|
|
// Property Fields
|
|
|
|
properties.push_back(address_data_pair(pr, pd));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
2021-08-25 17:20:33 -04:00
|
|
|
* @brief address_pair_list::oStream
|
|
|
|
* @param stream
|
2021-08-15 21:43:36 -04:00
|
|
|
*/
|
|
|
|
void address_pair_list::oStream(PDU::Stream stream) const
|
|
|
|
{
|
|
|
|
for (const auto & [range, vect] : properties)
|
|
|
|
{
|
2021-08-20 09:58:59 -04:00
|
|
|
*stream << range;
|
2021-08-15 21:43:36 -04:00
|
|
|
for (uint8_t d : vect)
|
|
|
|
*stream << d;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief address_list::streamSize
|
2021-07-29 11:20:03 -04:00
|
|
|
* @return
|
|
|
|
*/
|
2021-08-15 21:43:36 -04:00
|
|
|
size_t address_list::streamSize() const
|
|
|
|
{
|
|
|
|
size_t s = 0;
|
|
|
|
for (const auto & range : addresses)
|
|
|
|
s += range.streamSize();
|
|
|
|
return s;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief address_list::iStream
|
2021-08-25 17:20:33 -04:00
|
|
|
* @param stream
|
2021-08-15 21:43:36 -04:00
|
|
|
*/
|
|
|
|
void address_list::iStream(PDU::Stream stream)
|
|
|
|
{
|
|
|
|
while(stream->good())
|
|
|
|
{
|
|
|
|
// Property Address
|
2021-08-31 09:01:57 -04:00
|
|
|
addresses.emplace_back(range(type_));
|
2021-08-20 09:58:59 -04:00
|
|
|
*stream >> addresses.back();
|
2021-08-15 21:43:36 -04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief address_list::oStream
|
2021-08-25 17:20:33 -04:00
|
|
|
* @param stream
|
2021-08-15 21:43:36 -04:00
|
|
|
*/
|
|
|
|
void address_list::oStream(PDU::Stream stream) const
|
2021-07-29 11:20:03 -04:00
|
|
|
{
|
2021-08-15 21:43:36 -04:00
|
|
|
for (const auto & addr : addresses)
|
2021-08-20 09:58:59 -04:00
|
|
|
*stream << addr;
|
2021-07-29 11:20:03 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2021-07-26 21:15:48 -04:00
|
|
|
/**
|
|
|
|
* @brief Pdu::Pdu
|
|
|
|
* @param stream
|
|
|
|
*/
|
2021-07-29 19:26:49 -04:00
|
|
|
Pdu::Pdu()
|
|
|
|
: PDU::Pdu(1) // vectors are 1 octet
|
2021-05-27 10:59:22 -04:00
|
|
|
{
|
2021-07-29 19:26:49 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief DMP::Pdu::iStream
|
|
|
|
* @param stream
|
|
|
|
*/
|
|
|
|
void Pdu::iStream(PDU::Stream stream)
|
|
|
|
{
|
2021-08-16 10:14:39 -04:00
|
|
|
PDU::Pdu::iStream(stream); // flags, length, and vector
|
|
|
|
createHeader<address_type>(); // header
|
|
|
|
|
|
|
|
if (!flags_.hasData)
|
|
|
|
return;
|
|
|
|
|
2021-08-31 11:13:36 -04:00
|
|
|
auto header = std::static_pointer_cast<address_type>(this->header());
|
2021-08-16 10:14:39 -04:00
|
|
|
|
2021-09-01 12:31:19 -04:00
|
|
|
auto dataIsAddressList = [&] () {
|
2021-08-31 11:13:36 -04:00
|
|
|
data_ = std::make_shared<address_list>(*header);
|
2021-09-01 12:31:19 -04:00
|
|
|
data_->iStream(stream_);
|
2021-08-16 10:14:39 -04:00
|
|
|
};
|
|
|
|
|
2021-09-01 12:31:19 -04:00
|
|
|
auto dataIsAdddresPairList = [&] () {
|
2021-08-31 11:13:36 -04:00
|
|
|
data_ = std::make_shared<address_pair_list>(*header);
|
2021-09-01 12:31:19 -04:00
|
|
|
data_->iStream(stream_);
|
2021-08-16 10:14:39 -04:00
|
|
|
};
|
|
|
|
|
|
|
|
switch(vector()) {
|
|
|
|
case GET_PROPERTY:
|
|
|
|
dataIsAddressList();
|
|
|
|
break;
|
|
|
|
case SET_PROPERTY:
|
|
|
|
dataIsAdddresPairList();
|
|
|
|
break;
|
|
|
|
case GET_PROPERTY_REPLY:
|
|
|
|
dataIsAdddresPairList();
|
|
|
|
break;
|
|
|
|
case EVENT:
|
|
|
|
dataIsAdddresPairList();
|
|
|
|
break;
|
|
|
|
case SUBSCRIBE:
|
|
|
|
dataIsAddressList();
|
|
|
|
break;
|
|
|
|
case UNSUBSCRIBE:
|
|
|
|
dataIsAddressList();
|
|
|
|
break;
|
|
|
|
case GET_PROPERTY_FAIL:
|
|
|
|
dataIsAdddresPairList();
|
|
|
|
break;
|
|
|
|
case SET_PROPERTY_FAIL:
|
|
|
|
dataIsAdddresPairList();
|
|
|
|
break;
|
|
|
|
case SUBSCRIBE_ACCEPT:
|
|
|
|
dataIsAddressList();
|
|
|
|
break;
|
|
|
|
case SUBSCRIBE_REJECT:
|
|
|
|
dataIsAdddresPairList();
|
|
|
|
break;
|
|
|
|
case SYNC_EVENT:
|
|
|
|
dataIsAdddresPairList();
|
|
|
|
break;
|
|
|
|
}
|
2021-05-27 10:59:22 -04:00
|
|
|
}
|
|
|
|
|
2021-08-24 18:10:20 -04:00
|
|
|
} // ACN::DMP
|