123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379 |
- #ifndef _FASTDDS_RPTS_ELEM_SEQNUM_H_
- #define _FASTDDS_RPTS_ELEM_SEQNUM_H_
- #include <fastrtps/fastrtps_dll.h>
- #include <fastrtps/utils/fixed_size_bitmap.hpp>
- #include <fastdds/rtps/common/Types.h>
- #include <algorithm>
- #include <cassert>
- #include <vector>
- namespace eprosima {
- namespace fastrtps {
- namespace rtps {
- struct RTPS_DllAPI SequenceNumber_t
- {
-
- int32_t high = 0;
-
- uint32_t low = 0;
-
- SequenceNumber_t() noexcept
- {
- high = 0;
- low = 0;
- }
-
- SequenceNumber_t(
- int32_t hi,
- uint32_t lo) noexcept
- : high(hi)
- , low(lo)
- {
- }
-
- uint64_t to64long() const noexcept
- {
- return (static_cast<uint64_t>(high) << 32u) + low;
- }
-
- SequenceNumber_t& operator ++() noexcept
- {
- ++low;
- if (low == 0)
- {
- ++high;
- }
- return *this;
- }
- SequenceNumber_t operator ++(int) noexcept
- {
- SequenceNumber_t result(*this);
- ++(*this);
- return result;
- }
-
- SequenceNumber_t& operator +=(
- int inc) noexcept
- {
- uint32_t aux_low = low;
- low += inc;
- if (low < aux_low)
- {
-
- ++high;
- }
- return *this;
- }
- static SequenceNumber_t unknown() noexcept
- {
- return { -1, 0 };
- }
- };
- #ifndef DOXYGEN_SHOULD_SKIP_THIS_PUBLIC
- inline bool operator ==(
- const SequenceNumber_t& sn1,
- const SequenceNumber_t& sn2) noexcept
- {
- return (sn1.low == sn2.low) && (sn1.high == sn2.high);
- }
- inline bool operator !=(
- const SequenceNumber_t& sn1,
- const SequenceNumber_t& sn2) noexcept
- {
- return (sn1.low != sn2.low) || (sn1.high != sn2.high);
- }
- inline bool operator >(
- const SequenceNumber_t& seq1,
- const SequenceNumber_t& seq2) noexcept
- {
- if (seq1.high == seq2.high)
- {
- return seq1.low > seq2.low;
- }
- return seq1.high > seq2.high;
- }
- inline bool operator <(
- const SequenceNumber_t& seq1,
- const SequenceNumber_t& seq2) noexcept
- {
- if (seq1.high == seq2.high)
- {
- return seq1.low < seq2.low;
- }
- return seq1.high < seq2.high;
- }
- inline bool operator >=(
- const SequenceNumber_t& seq1,
- const SequenceNumber_t& seq2) noexcept
- {
- if (seq1.high == seq2.high)
- {
- return seq1.low >= seq2.low;
- }
- return seq1.high > seq2.high;
- }
- inline bool operator <=(
- const SequenceNumber_t& seq1,
- const SequenceNumber_t& seq2) noexcept
- {
- if (seq1.high == seq2.high)
- {
- return seq1.low <= seq2.low;
- }
- return seq1.high < seq2.high;
- }
- inline SequenceNumber_t operator -(
- const SequenceNumber_t& seq,
- const uint32_t inc) noexcept
- {
- SequenceNumber_t res(seq.high, seq.low - inc);
- if (inc > seq.low)
- {
-
- --res.high;
- }
- return res;
- }
- inline SequenceNumber_t operator +(
- const SequenceNumber_t& seq,
- const uint32_t inc) noexcept
- {
- SequenceNumber_t res(seq.high, seq.low + inc);
- if (res.low < seq.low)
- {
-
- ++res.high;
- }
- return res;
- }
- inline SequenceNumber_t operator -(
- const SequenceNumber_t& minuend,
- const SequenceNumber_t& subtrahend) noexcept
- {
- assert(minuend >= subtrahend);
- SequenceNumber_t res(minuend.high - subtrahend.high, minuend.low - subtrahend.low);
- if (minuend.low < subtrahend.low)
- {
- --res.high;
- }
- return res;
- }
- #endif
- const SequenceNumber_t c_SequenceNumber_Unknown(-1,0);
- #ifndef DOXYGEN_SHOULD_SKIP_THIS_PUBLIC
- inline bool sort_seqNum(
- const SequenceNumber_t& s1,
- const SequenceNumber_t& s2) noexcept
- {
- return s1 < s2;
- }
- inline std::ostream& operator <<(
- std::ostream& output,
- const SequenceNumber_t& seqNum)
- {
- return output << seqNum.to64long();
- }
- inline std::ostream& operator <<(
- std::ostream& output,
- const std::vector<SequenceNumber_t>& seqNumSet)
- {
- for(const SequenceNumber_t& sn : seqNumSet)
- {
- output << sn << " ";
- }
- return output;
- }
- struct SequenceNumberHash
- {
- std::size_t operator ()(
- const SequenceNumber_t& sequence_number) const noexcept
- {
- return static_cast<std::size_t>(sequence_number.to64long());
- }
- };
- struct SequenceNumberDiff
- {
- uint32_t operator ()(
- const SequenceNumber_t& a,
- const SequenceNumber_t& b) const noexcept
- {
- SequenceNumber_t diff = a - b;
- return diff.low;
- }
- };
- #endif
- using SequenceNumberSet_t = BitmapRange<SequenceNumber_t, SequenceNumberDiff, 256>;
- #ifndef DOXYGEN_SHOULD_SKIP_THIS_PUBLIC
- inline std::ostream& operator <<(
- std::ostream& output,
- const SequenceNumberSet_t& sns)
- {
- output << sns.base().to64long() << ":";
- sns.for_each([&output](
- SequenceNumber_t it)
- {
- output << it.to64long() << "-";
- });
- return output;
- }
- #endif
- }
- }
- }
- #endif
|