rt-thread/examples/libc/mq.c

130 lines
3.4 KiB
C
Raw Normal View History

/*
* Copyright (c) 2006-2021, RT-Thread Development Team
*
* SPDX-License-Identifier: Apache-2.0
*
* Change Logs:
* Date Author Notes
* 2010-11-17 Bernard first version
*/
2013-01-08 21:05:02 +08:00
#include <stdio.h>
#include <fcntl.h>
#include <stdlib.h>
#include <string.h>
#include <pthread.h>
#include <mqueue.h>
#define MQ_NAME_1 "testmsg1"
#define MQ_NAME_2 "testmsg2"
2021-03-07 08:34:04 +08:00
#define MSG_SIZE 128
#define MAX_MSG 3
2013-01-08 21:05:02 +08:00
const char *s_msg_ptr[] = {"msg test 1", "msg test 2", "msg test 3"};
char r_msg_ptr_1[MAX_MSG][MSG_SIZE];
char r_msg_ptr_2[MAX_MSG][MSG_SIZE];
pthread_t send1, send2, rev1, rev2;
2021-03-07 08:34:04 +08:00
int * send_1(void * mq)
2013-01-08 21:05:02 +08:00
{
2021-03-07 08:34:04 +08:00
int i;
mqd_t mq1 = *(mqd_t *)mq;
2013-01-08 21:05:02 +08:00
2021-03-07 08:34:04 +08:00
printf("Enter into send_1 \n");
for (i = 0; i < MAX_MSG; i++ ) {
if ( -1 == mq_send(mq1, s_msg_ptr[i], MSG_SIZE, i)) {
perror("mq_send doesn't return success \n");
pthread_exit((void *)1);
}
printf("[%d] send '%s' in thread send_1. \n", i+1, s_msg_ptr[i]);
}
pthread_exit((void *)0);
2013-01-08 21:05:02 +08:00
}
2021-03-07 08:34:04 +08:00
int * send_2(void * mq)
2013-01-08 21:05:02 +08:00
{
2021-03-07 08:34:04 +08:00
int i;
mqd_t mq2 = *(mqd_t *)mq;
2013-01-08 21:05:02 +08:00
2021-03-07 08:34:04 +08:00
printf("Enter into send_2 \n");
for (i = 0; i < MAX_MSG; i++ ) {
if ( -1 == mq_send(mq2, s_msg_ptr[i], MSG_SIZE, i)) {
perror("mq_send doesn't return success \n");
pthread_exit((void *)1);
}
printf("[%d] send '%s' in thread send_2. \n", i+1, s_msg_ptr[i]);
}
pthread_exit((void *)0);
2013-01-08 21:05:02 +08:00
}
2021-03-07 08:34:04 +08:00
int * receive_1(void * mq)
2013-01-08 21:05:02 +08:00
{
2021-03-07 08:34:04 +08:00
int i;
mqd_t mq1 = *(mqd_t *)mq;
2013-01-08 21:05:02 +08:00
2021-03-07 08:34:04 +08:00
printf("Enter into receive_1 \n");
for (i = 0; i< MAX_MSG; i++) {
if ( -1 == mq_receive(mq1, r_msg_ptr_1[i], MSG_SIZE, NULL) ) {
perror("mq_receive doesn't return success \n");
pthread_exit((void *)1);
}
printf("[%d] receive '%s' in thread receive_1. \n", i+1, r_msg_ptr_1[i]);
}
pthread_exit((void *)0);
2013-01-08 21:05:02 +08:00
}
2021-03-07 08:34:04 +08:00
int * receive_2(void * mq)
2013-01-08 21:05:02 +08:00
{
2021-03-07 08:34:04 +08:00
int i;
mqd_t mq2 = *(mqd_t *)mq;
2013-01-08 21:05:02 +08:00
2021-03-07 08:34:04 +08:00
printf("Enter into receive_2 \n");
for (i = 0; i< MAX_MSG; i++) {
if ( -1 == mq_receive(mq2, r_msg_ptr_2[i], MSG_SIZE, NULL) ) {
perror("mq_receive doesn't return success \n");
pthread_exit((void *)1);
}
printf("[%d] receive '%s' in thread receive_2. \n", i+1, r_msg_ptr_2[i]);
}
pthread_exit((void *)0);
2013-01-08 21:05:02 +08:00
}
int libc_mq()
{
2021-03-07 08:34:04 +08:00
mqd_t mq1 = 0, mq2 = 0;
struct mq_attr mqstat;
int oflag = O_CREAT|O_RDWR;
2013-01-08 21:05:02 +08:00
2021-03-07 08:34:04 +08:00
memset(&mqstat, 0, sizeof(mqstat));
mqstat.mq_maxmsg = MAX_MSG;
mqstat.mq_msgsize = MSG_SIZE;
mqstat.mq_flags = 0;
2013-01-08 21:05:02 +08:00
2021-03-07 08:34:04 +08:00
if( ((mqd_t) -1) == (mq1 = mq_open(MQ_NAME_1,oflag,0777, &mqstat)) ) {
printf("mq_open doesn't return success \n");
return -1;
}
if( ((mqd_t) -1) == (mq2 = mq_open(MQ_NAME_2,oflag,0777, &mqstat)) ) {
printf("mq_open doesn't return success \n");
return -1;
}
pthread_create(&send1, NULL, (void *)send_1, (void *)&mq1);
pthread_create(&send2, NULL, (void *)send_2, (void *)&mq2);
pthread_create(&rev1, NULL, (void *)receive_1, (void *)&mq1);
pthread_create(&rev2, NULL, (void *)receive_2, (void *)&mq2);
pthread_join(send1, NULL);
pthread_join(send2, NULL);
pthread_join(rev1, NULL);
pthread_join(rev2, NULL);
mq_close(mq1);
mq_close(mq2);
mq_unlink(MQ_NAME_1);
mq_unlink(MQ_NAME_2);
printf("PASSED\n");
return 0;
2013-01-08 21:05:02 +08:00
}
#include <finsh.h>
FINSH_FUNCTION_EXPORT(libc_mq, posix mqueue test);