File indexing completed on 2025-05-11 08:24:21
0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011
0012
0013
0014
0015
0016
0017
0018
0019
0020
0021
0022
0023
0024
0025
0026
0027
0028
0029
0030
0031
0032
0033
0034
0035
0036
0037 #ifdef HAVE_CONFIG_H
0038 #include "config.h"
0039 #endif
0040
0041 #include <rtems/posix/mqueueimpl.h>
0042
0043 #include <signal.h>
0044
0045 static void _POSIX_Message_queue_Notify_handler(
0046 CORE_message_queue_Control *the_message_queue,
0047 Thread_queue_Context *queue_context
0048 )
0049 {
0050 POSIX_Message_queue_Control *the_mq;
0051 int signo;
0052
0053 the_mq = RTEMS_CONTAINER_OF(
0054 the_message_queue,
0055 POSIX_Message_queue_Control,
0056 Message_queue
0057 );
0058
0059 signo = the_mq->notification.sigev_signo;
0060 _CORE_message_queue_Set_notify( &the_mq->Message_queue, NULL );
0061 _CORE_message_queue_Release( &the_mq->Message_queue, queue_context );
0062
0063 kill( getpid(), signo );
0064 }
0065
0066 int mq_notify(
0067 mqd_t mqdes,
0068 const struct sigevent *notification
0069 )
0070 {
0071 POSIX_Message_queue_Control *the_mq;
0072 Thread_queue_Context queue_context;
0073
0074 the_mq = _POSIX_Message_queue_Get( mqdes, &queue_context );
0075
0076 if ( the_mq == NULL ) {
0077 rtems_set_errno_and_return_minus_one( EBADF );
0078 }
0079
0080 _CORE_message_queue_Acquire_critical(
0081 &the_mq->Message_queue,
0082 &queue_context
0083 );
0084
0085 if ( the_mq->open_count == 0 ) {
0086 _CORE_message_queue_Release( &the_mq->Message_queue, &queue_context );
0087 rtems_set_errno_and_return_minus_one( EBADF );
0088 }
0089
0090 if ( notification != NULL ) {
0091 if ( _CORE_message_queue_Is_notify_enabled( &the_mq->Message_queue ) ) {
0092 _CORE_message_queue_Release( &the_mq->Message_queue, &queue_context );
0093 rtems_set_errno_and_return_minus_one( EBUSY );
0094 }
0095
0096 the_mq->notification = *notification;
0097
0098 _CORE_message_queue_Set_notify(
0099 &the_mq->Message_queue,
0100 _POSIX_Message_queue_Notify_handler
0101 );
0102 } else {
0103 _CORE_message_queue_Set_notify( &the_mq->Message_queue, NULL );
0104 }
0105
0106 _CORE_message_queue_Release( &the_mq->Message_queue, &queue_context );
0107 return 0;
0108 }