ipc_array

// vi:set ft=cpp: -*- Mode: C++ -*-
/*
 * (c) 2014 Alexander Warg <alexander.warg@kernkonzept.com>
 *
 * License: see LICENSE.spdx (in this directory or the directories above)
 */
#pragma once
 
#include "types"
#include "ipc_basics"
#include "ipc_types"
 
namespace L4 { namespace Ipc L4_EXPORT {

typedef unsigned short Array_len_default;

template< typename ELEM_TYPE, typename LEN_TYPE = Array_len_default >
struct Array_ref
{
  typedef ELEM_TYPE *ptr_type;
  typedef LEN_TYPE len_type;
 
  len_type length;
  ptr_type data;
  Array_ref() = default;
  Array_ref(len_type length, ptr_type data)
  : length(length), data(data)
  {}
 
  template<typename X> struct Non_const
  { typedef Array_ref<X, LEN_TYPE> type; };
 
  template<typename X> struct Non_const<X const>
  { typedef Array_ref<X, LEN_TYPE> type; };
 
  Array_ref(typename Non_const<ELEM_TYPE>::type const &other)
  : length(other.length), data(other.data)
  {}
 
  Array_ref &operator = (typename Non_const<ELEM_TYPE>::type const &other)
  {
    this->length = other.length;
    this->data = other.data;
    return *this;
  }
};

template<typename ELEM_TYPE, typename LEN_TYPE = Array_len_default>
struct Array : Array_ref<ELEM_TYPE , LEN_TYPE>
{
  Array() {}
  Array(LEN_TYPE length, ELEM_TYPE *data)
  : Array_ref<ELEM_TYPE, LEN_TYPE>(length, data)
  {}
 
  template<typename X> struct Non_const
  { typedef Array<X, LEN_TYPE> type; };
 
  template<typename X> struct Non_const<X const>
  { typedef Array<X, LEN_TYPE> type; };

  Array(typename Non_const<ELEM_TYPE>::type const &other)
  : Array_ref<ELEM_TYPE, LEN_TYPE>(other.length, other.data)
  {}
 
  Array &operator = (typename Non_const<ELEM_TYPE>::type const &other)
  {
    this->length = other.length;
    this->data = other.data;
    return *this;
  }
};

template< typename ELEM_TYPE,
          typename LEN_TYPE = Array_len_default,
          LEN_TYPE MAX      = (L4_UTCB_GENERIC_DATA_SIZE *
                                sizeof(l4_umword_t)) / sizeof(ELEM_TYPE) >
struct Array_in_buf
{
  typedef Array_ref<ELEM_TYPE, LEN_TYPE> array;
  typedef Array_ref<ELEM_TYPE const, LEN_TYPE> const_array;

  ELEM_TYPE data[MAX];
  LEN_TYPE length;

  void copy_in(const_array a)
  {
    length = a.length;
    if (length > MAX)
      length = MAX;
 
    for (LEN_TYPE i = 0; i < length; ++i)
      data[i] = a.data[i];
  }

  Array_in_buf(const_array a)  { copy_in(a); }
  Array_in_buf(array a)  { copy_in(a); }
};
 
// implementation details for transmission
namespace Msg {

template<typename A, typename LEN>
struct Elem< Array<A, LEN> >
{
  typedef Array<A, LEN> arg_type;
  typedef Array_ref<A, LEN> svr_type;
  typedef svr_type svr_arg_type;
  enum { Is_optional = false };
};

template<typename A, typename LEN>
struct Elem< Array<A, LEN> & >
{
  typedef Array<A, LEN> &arg_type;
  typedef Array_ref<A, LEN> svr_type;
  typedef svr_type &svr_arg_type;
  enum { Is_optional = false };
};

template<typename A, typename LEN>
struct Elem< Array_ref<A, LEN> & >
{
  typedef Array_ref<A, LEN> &arg_type;
  typedef Array_ref<typename L4::Types::Remove_const<A>::type, LEN> svr_type;
  typedef svr_type &svr_arg_type;
  enum { Is_optional = false };
};
 
template<typename A> struct Class<Array<A> > : Class<A>::type {};
template<typename A> struct Class<Array_ref<A> > : Class<A>::type {};
 
namespace Detail {
 
template<typename A, typename LEN, typename ARRAY, bool REF>
struct Clnt_val_ops_d_in : Clnt_noops<ARRAY>
{
  using Clnt_noops<ARRAY>::to_msg;
  static int to_msg(char *msg, unsigned offset, unsigned limit,
                    ARRAY a, Dir_in, Cls_data)
  {
    offset = align_to<LEN>(offset);
    if (L4_UNLIKELY(!check_size<LEN>(offset, limit)))
      return -L4_EMSGTOOLONG;
    *reinterpret_cast<LEN *>(msg + offset) = a.length;
    offset = align_to<A>(offset + sizeof(LEN));
    if (L4_UNLIKELY(!check_size<A>(offset, limit, a.length)))
      return -L4_EMSGTOOLONG;
    typedef typename L4::Types::Remove_const<A>::type elem_type;
    elem_type *data = reinterpret_cast<elem_type*>(msg + offset);
 
    // we do not correctly handle overlaps
    if (!REF || data != a.data)
      {
        for (LEN i = 0; i < a.length; ++i)
          data[i] = a.data[i];
      }
 
    return offset + a.length * sizeof(A);
  }
};
} // namespace Detail
 
template<typename A, typename LEN>
struct Clnt_val_ops<Array<A, LEN>, Dir_in, Cls_data> :
  Detail::Clnt_val_ops_d_in<A, LEN, Array<A, LEN>, false> {};
 
template<typename A, typename LEN>
struct Clnt_val_ops<Array_ref<A, LEN>, Dir_in, Cls_data> :
  Detail::Clnt_val_ops_d_in<A, LEN, Array_ref<A, LEN>, true> {};
 
template<typename A, typename LEN, typename CLASS>
struct Svr_val_ops< Array_ref<A, LEN>, Dir_in, CLASS >
: Svr_noops< Array_ref<A, LEN> >
{
  typedef Array_ref<A, LEN> svr_type;
 
  using Svr_noops<svr_type>::to_svr;
  static int to_svr(char *msg, unsigned offset, unsigned limit,
                    svr_type &a, Dir_in, Cls_data)
  {
    offset = align_to<LEN>(offset);
    if (L4_UNLIKELY(!check_size<LEN>(offset, limit)))
      return -L4_EMSGTOOSHORT;
    a.length = *reinterpret_cast<LEN *>(msg + offset);
    offset = align_to<A>(offset + sizeof(LEN));
    if (L4_UNLIKELY(!check_size<A>(offset, limit, a.length)))
      return -L4_EMSGTOOSHORT;
    a.data = reinterpret_cast<A*>(msg + offset);
    return offset + a.length * sizeof(A);
  }
};
 
template<typename A, typename LEN>
struct Svr_xmit< Array<A, LEN> > : Svr_xmit< Array_ref<A, LEN> > {};
 
template<typename A, typename LEN>
struct Clnt_val_ops<Array<A, LEN>, Dir_out, Cls_data> : Clnt_noops<Array<A, LEN> >
{
  typedef Array<A, LEN> type;
 
  using Clnt_noops<type>::from_msg;
  static int from_msg(char *msg, unsigned offset, unsigned limit, long,
                      type &a, Dir_out, Cls_data)
  {
    offset = align_to<LEN>(offset);
    if (L4_UNLIKELY(!check_size<LEN>(offset, limit)))
      return -L4_EMSGTOOSHORT;
 
    LEN l = *reinterpret_cast<LEN *>(msg + offset);
 
    offset = align_to<A>(offset + sizeof(LEN));
    if (L4_UNLIKELY(!check_size<A>(offset, limit, l)))
      return -L4_EMSGTOOSHORT;
 
    A *data = reinterpret_cast<A*>(msg + offset);
 
    if (l > a.length)
      l = a.length;
    else
      a.length = l;
 
    for (unsigned i = 0; i < l; ++i)
      a.data[i] = data[i];
 
    return offset + l * sizeof(A);
  };
};
 
template<typename A, typename LEN>
struct Clnt_val_ops<Array_ref<A, LEN>, Dir_out, Cls_data> :
  Clnt_noops<Array_ref<A, LEN> >
{
  typedef Array_ref<A, LEN> type;
 
  using Clnt_noops<type>::from_msg;
  static int from_msg(char *msg, unsigned offset, unsigned limit, long,
                      type &a, Dir_out, Cls_data)
  {
    offset = align_to<LEN>(offset);
    if (L4_UNLIKELY(!check_size<LEN>(offset, limit)))
      return -L4_EMSGTOOSHORT;
 
    LEN l = *reinterpret_cast<LEN *>(msg + offset);
 
    offset = align_to<A>(offset + sizeof(LEN));
    if (L4_UNLIKELY(!check_size<A>(offset, limit, l)))
      return -L4_EMSGTOOSHORT;
 
    a.data = reinterpret_cast<A*>(msg + offset);
    a.length = l;
    return offset + l * sizeof(A);
  };
};
 
template<typename A, typename LEN, typename CLASS>
struct Svr_val_ops<Array_ref<A, LEN>, Dir_out, CLASS> :
  Svr_noops<Array_ref<typename L4::Types::Remove_const<A>::type, LEN> &>
{
  typedef typename L4::Types::Remove_const<A>::type elem_type;
  typedef Array_ref<elem_type, LEN> &svr_type;
 
  using Svr_noops<svr_type>::to_svr;
  static int to_svr(char *msg, unsigned offset, unsigned limit,
                    svr_type a, Dir_out, Cls_data)
  {
    offset = align_to<LEN>(offset);
    if (L4_UNLIKELY(!check_size<LEN>(offset, limit)))
      return -L4_EMSGTOOLONG;
 
    offset = align_to<A>(offset + sizeof(LEN));
    a.data = reinterpret_cast<elem_type *>(msg + offset);
    a.length = (limit-offset) / sizeof(A);
    return offset;
  }
 
  using Svr_noops<svr_type>::from_svr;
  static int from_svr(char *msg, unsigned offset, unsigned limit, long,
                      svr_type a, Dir_out, Cls_data)
  {
    offset = align_to<LEN>(offset);
    if (L4_UNLIKELY(!check_size<LEN>(offset, limit)))
      return -L4_EMSGTOOLONG;
 
    *reinterpret_cast<LEN *>(msg + offset) = a.length;
 
    offset = align_to<A>(offset + sizeof(LEN));
    if (L4_UNLIKELY(!check_size<A>(offset, limit, a.length)))
      return -L4_EMSGTOOLONG;
 
    return offset + a.length * sizeof(A);
  }
};
 
template<typename A, typename LEN>
struct Svr_xmit<Array<A, LEN> &> : Svr_xmit<Array_ref<A, LEN> &> {};
 
// Pointer to array is not implemented.
template<typename A, typename LEN>
struct Is_valid_rpc_type< Array_ref<A, LEN> *> : L4::Types::False {};
 
// Optional input arrays are not implemented.
template<typename A, typename LEN>
struct Is_valid_rpc_type< Opt<Array_ref<A, LEN> > > : L4::Types::False {};
 
} // namespace Msg
 
}}