diff options
-rw-r--r-- | low-can-binding/can/message/message.cpp | 34 | ||||
-rw-r--r-- | low-can-binding/can/message/message.hpp | 1 |
2 files changed, 35 insertions, 0 deletions
diff --git a/low-can-binding/can/message/message.cpp b/low-can-binding/can/message/message.cpp index 5384c021..b0a33f78 100644 --- a/low-can-binding/can/message/message.cpp +++ b/low-can-binding/can/message/message.cpp @@ -76,6 +76,40 @@ const uint8_t* message_t::get_data() const return data_.data(); } + +/// +/// @brief Retrieve data_ member value. +/// +/// @return pointer to the first element +/// of class member data_ +/// +const std::vector<uint8_t> message_t::get_data_vector(int start,int end) const +{ + std::vector<uint8_t> ret; + if(start >= 0) + { + if(end<length_) + { + for(int i=start;i<=end;i++) + { + ret.push_back(data_[i]); + } + } + else + { + for(int i=start;i<length_;i++) + { + ret.push_back(data_[i]); + } + } + } + else + { + AFB_ERROR("Error index to get data vector, [%d-%d] - for length %d",start,end,length_); + } + return ret; +} + /// /// @brief Retrieve data_ member whole vector /// diff --git a/low-can-binding/can/message/message.hpp b/low-can-binding/can/message/message.hpp index 48f4d98b..f0e1bf0b 100644 --- a/low-can-binding/can/message/message.hpp +++ b/low-can-binding/can/message/message.hpp @@ -66,6 +66,7 @@ public: int get_sub_id() const; const uint8_t* get_data() const; const std::vector<uint8_t> get_data_vector() const; + const std::vector<uint8_t> get_data_vector(int start,int end) const; uint32_t get_length() const; uint64_t get_timestamp() const; |