include/wipal/phy/avs_header.hxx

/*
 * WiPal - A library and a set of tools to manipulate wireless traces.
 * Copyright (C) 2007, 2008, 2009  Universite Pierre et Marie Curie - Paris 6
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
 * MA  02110-1301  USA
 *
 * Author: Thomas Claveirole <thomas.claveirole@lip6.fr>
 */
#ifndef AVS_HEADER_HXX_
# define AVS_HEADER_HXX_

# include "avs_header.hh"

# include <stdexcept>
# include <cstring>

# include <wipal/tool/endianness.hh>

namespace wpl
{

  namespace avs
  {

    inline
    size_t
    header::len_impl(size_t caplen, bool) const
    {
      if (not caplen)
        return caplen + 1;

      return tool::extract_big_endian_long_u(length);
    }

    inline
    header::time_type
    header::time_get_impl(bool) const
    {
      return mactime_get();
    }

    inline
    void
    header::time_set_impl(const time_type& t, bool)
    {
      const uint64_t    v = t.get_impl();

      if (not tool::need_swap(tool::end::big, false))
        mactime = v;
      else
        {
          const uint32_t  lo = tool::extract_swapped_long_u(v & uint32_t (-1));
          const uint32_t  hi = tool::extract_swapped_long_u(v >> 32);

          // The intent of that ``double-cast'' is to avoid GCC complaining
          // about type-punned pointers which break strict aliasing rules.

          void* const      v = static_cast<void*> (&mactime);
          uint32_t* const  u = static_cast<uint32_t*> (v);

          u[0] = hi;
          u[1] = lo;
        }
    }

    template <class S1, class S2>
    bool
    header::eq_time(const pkt::packet<S1>&              lhs,
                    const pkt::packet<S2>&              rhs,
                    const unsigned                      prec,
                    const tool::end::endianness         )
    {
      const size_t              lhs_caplen = lhs.meta().caplen;
      const size_t              rhs_caplen = rhs.meta().caplen;

      const header* const       lhs_phy = (static_cast<const header*>
                                           (lhs.bytes()));
      const header* const       rhs_phy = (static_cast<const header*>
                                           (rhs.bytes()));

      if (lhs_phy->len(lhs_caplen, false) > lhs_caplen or
          rhs_phy->len(rhs_caplen, false) > rhs_caplen)
        return false;

      return std::abs(int64_t (lhs_phy->mactime_get() -
                               rhs_phy->mactime_get())) <= prec;
    }

    inline
    uint64_t
    header::mactime_get() const
    {
      return uint64_get(&mactime);
    }

    inline
    uint64_t
    header::hosttime_get() const
    {
      return uint64_get(&hosttime);
    }

    inline
    uint64_t
    header::uint64_get(const void* p)
    {
      if (not tool::need_swap(tool::end::big, false))
        return *static_cast<const uint64_t*> (p);
      else
        {
          const uint32_t* const p32 = static_cast<const uint32_t*> (p);

          const uint32_t        hi = tool::extract_big_endian_long_u(p32[0]);
          const uint32_t        lo = tool::extract_big_endian_long_u(p32[1]);

          return (uint64_t (hi) << 32) | lo;
        }
    }

  } // End of namespace wpl::avs.

} // End of namespace wpl.

#endif // ! AVS_HEADER_HXX_

---