path: root/c/src/librtems++/src/rtemsMessageQueue.cc

/*
  ------------------------------------------------------------------------

  COPYRIGHT (c) 1997
  Objective Design Systems Ltd Pty (ODS)
  All rights reserved (R) Objective Design Systems Ltd Pty
  
  The license and distribution terms for this file may be found in the
  file LICENSE in this distribution or at
  http://www.rtems.org/license/LICENSE.

  ------------------------------------------------------------------------

  See header file.

  ------------------------------------------------------------------------
*/

#include <cstring>
#include <rtems++/rtemsMessageQueue.h>

/* ----
   rtemsMessageQueue
*/

rtemsMessageQueue::rtemsMessageQueue(const char* mqname,
                                     const uint32_t count,
                                     const size_t max_message_size,
                                     const WaitMode wait_mode,
                                     const Scope scope)
  : name(0),
    owner(true),
    id(0)
{
  strcpy(name_str, "NOID");
  create(mqname, count, max_message_size, wait_mode, scope);
}

rtemsMessageQueue::rtemsMessageQueue(const char *mqname,
                                     const uint32_t node)
  : name(0),
    owner(false),
    id(0)
{
  strcpy(name_str, "NOID");
  connect(mqname, node);
}

rtemsMessageQueue::rtemsMessageQueue(const rtemsMessageQueue& message_queue)
  : name(0),
    owner(false),
    id(0)
{
  name = message_queue.name;
  strcpy(name_str, message_queue.name_str);
  id = message_queue.id;
}

rtemsMessageQueue::rtemsMessageQueue()
  : name(0),
    owner(false),
    id(0)
{
  strcpy(name_str, "NOID");
}

rtemsMessageQueue::~rtemsMessageQueue()
{
  destroy();
}

void rtemsMessageQueue::make_invalid()
{
  strcpy(name_str, "NOID");
  name = 0;
  id = 0;
  owner = false;
}

const rtems_status_code rtemsMessageQueue::create(const char* mqname,
                                                  const uint32_t count,
                                                  const size_t max_message_size,
                                                  const WaitMode wait_mode,
                                                  const Scope scope)
{
  if (id)
    return set_status_code(RTEMS_ILLEGAL_ON_SELF);

  owner = true;
  
  strcpy(name_str, "    ");
  for (int c = 0; (c < 4) && (mqname[c] != '\0'); c++)
    name_str[c] = mqname[c];
  name = rtems_build_name(name_str[0],
                          name_str[1],
                          name_str[2],
                          name_str[3]);
  
  set_status_code(rtems_message_queue_create(name,
                                             count,
                                             max_message_size,
                                             scope | wait_mode,
                                             &id));

  if (unsuccessful())
  {
    make_invalid();
  }
  
  return last_status_code();
}

const rtems_status_code rtemsMessageQueue::destroy()
{
  if (id && owner)
  {
    set_status_code(rtems_message_queue_delete(id));
    make_invalid();
  }
  else
    set_status_code(RTEMS_NOT_OWNER_OF_RESOURCE);
  
  return last_status_code();
}

const rtemsMessageQueue& rtemsMessageQueue::operator=(const rtemsMessageQueue& message_queue)
{
  if (!owner)
  {
    name = message_queue.name;
    strcpy(name_str, message_queue.name_str);
    id = message_queue.id;
  }

  return *this;
}
  
const rtems_status_code rtemsMessageQueue::connect(const char *mqname,
                                                   const uint32_t node)
{
  if (id && owner)
    return set_status_code(RTEMS_UNSATISFIED);

  // change state to not owner
  owner = false;
  
  strcpy(name_str, "    ");
  for (int c = 0; (c < 4) && (mqname[c] != '\0'); c++)
    name_str[c] = mqname[c];
  name = rtems_build_name(name_str[0],
                          name_str[1],
                          name_str[2],
                          name_str[3]);
  
  set_status_code(rtems_message_queue_ident(name, node, &id));

  if (unsuccessful())
  {
    make_invalid();
  }
  
  return last_status_code();
}