mq_msgqalloc.c 4.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115
  1. /****************************************************************************
  2. * sched/mqueue/mq_msgqalloc.c
  3. *
  4. * Copyright (C) 2014, 2017 Gregory Nutt. All rights reserved.
  5. * Author: Gregory Nutt <gnutt@nuttx.org>
  6. *
  7. * Redistribution and use in source and binary forms, with or without
  8. * modification, are permitted provided that the following conditions
  9. * are met:
  10. *
  11. * 1. Redistributions of source code must retain the above copyright
  12. * notice, this list of conditions and the following disclaimer.
  13. * 2. Redistributions in binary form must reproduce the above copyright
  14. * notice, this list of conditions and the following disclaimer in
  15. * the documentation and/or other materials provided with the
  16. * distribution.
  17. * 3. Neither the name NuttX nor the names of its contributors may be
  18. * used to endorse or promote products derived from this software
  19. * without specific prior written permission.
  20. *
  21. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  22. * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  23. * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
  24. * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
  25. * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
  26. * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
  27. * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
  28. * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
  29. * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  30. * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
  31. * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  32. * POSSIBILITY OF SUCH DAMAGE.
  33. *
  34. ****************************************************************************/
  35. /****************************************************************************
  36. * Included Files
  37. ****************************************************************************/
  38. #include <nuttx/config.h>
  39. #include <mqueue.h>
  40. #include <assert.h>
  41. #include <nuttx/kmalloc.h>
  42. #include <nuttx/sched.h>
  43. #include <nuttx/mqueue.h>
  44. #include "sched/sched.h"
  45. #include "mqueue/mqueue.h"
  46. /****************************************************************************
  47. * Public Functions
  48. ****************************************************************************/
  49. /****************************************************************************
  50. * Name: nxmq_alloc_msgq
  51. *
  52. * Description:
  53. * This function implements a part of the POSIX message queue open logic.
  54. * It allocates and initializes a struct mqueue_inode_s structure.
  55. *
  56. * Input Parameters:
  57. * mode - mode_t value is ignored
  58. * attr - The mq_maxmsg attribute is used at the time that the message
  59. * queue is created to determine the maximum number of
  60. * messages that may be placed in the message queue.
  61. *
  62. * Returned Value:
  63. * The allocated and initialized message queue structure or NULL in the
  64. * event of a failure.
  65. *
  66. ****************************************************************************/
  67. FAR struct mqueue_inode_s *nxmq_alloc_msgq(mode_t mode,
  68. FAR struct mq_attr *attr)
  69. {
  70. FAR struct mqueue_inode_s *msgq;
  71. /* Check if the caller is attempting to allocate a message for messages
  72. * larger than the configured maximum message size.
  73. */
  74. DEBUGASSERT(!attr || attr->mq_msgsize <= MQ_MAX_BYTES);
  75. if (attr && attr->mq_msgsize > MQ_MAX_BYTES)
  76. {
  77. return NULL;
  78. }
  79. /* Allocate memory for the new message queue. */
  80. msgq = (FAR struct mqueue_inode_s *)
  81. kmm_zalloc(sizeof(struct mqueue_inode_s));
  82. if (msgq)
  83. {
  84. /* Initialize the new named message queue */
  85. sq_init(&msgq->msglist);
  86. if (attr)
  87. {
  88. msgq->maxmsgs = (int16_t)attr->mq_maxmsg;
  89. msgq->maxmsgsize = (int16_t)attr->mq_msgsize;
  90. }
  91. else
  92. {
  93. msgq->maxmsgs = MQ_MAX_MSGS;
  94. msgq->maxmsgsize = MQ_MAX_BYTES;
  95. }
  96. msgq->ntpid = INVALID_PROCESS_ID;
  97. }
  98. return msgq;
  99. }