rtemsmessagequeue.cc

来自「RTEMS (Real-Time Executive for Multiproc」· CC 代码 · 共 166 行

/*
  ------------------------------------------------------------------------
  $Id: rtemsMessageQueue.cc,v 1.2.8.1 2003/09/04 18:46:06 joel Exp $
  ------------------------------------------------------------------------

  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.com/license/LICENSE.

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

  See header file.

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

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

/* ----
   rtemsMessageQueue
*/

rtemsMessageQueue::rtemsMessageQueue(const char* mqname,
                                     const rtems_unsigned32 count,
                                     const rtems_unsigned32 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 rtems_unsigned32 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 rtems_unsigned32 count,
                                                  const rtems_unsigned32 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 rtems_unsigned32 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();
}