Skip to content

P
proview
Commit 8d7cc252 authored by claes's avatar claes
Browse files
Options

*** empty log message ***

parent b9ef9d81
Hide whitespace changes
Inline Side-by-side
Showing with 0 additions and 347 deletions
src/lib/rt/src/os_linux/rt_mq.c deleted 100644 → 0
View file @ b9ef9d81
/*
* Proview $Id: rt_mq.c,v 1.4 2006-02-01 09:12:17 claes Exp $
* Copyright (C) GARRET.
*
* Distribution terms
* Permission is hereby granted, free of charge, to any person
* obtaining a copy of this software and associated documentation
* files (the Software), to deal in the Software without
* restriction, including without limitation the rights to use,
* copy, modify, merge, publish, distribute, sublicense, and/or
* sell copies of the Software, and to permit persons to whom
* the Software is furnished to do so, subject to the following
* conditions:
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
* OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
* NONINFRINGEMENT.
* IN NO EVENT SHALL THE AUTHOR OF THIS SOFTWARE BE LIABLE FOR ANY
* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF
* CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*/
/*-< MQUEUE.C >-----------------------------------------------------*--------*/
/* POSIX.1b Version 1.0 (c) 1998 GARRET * ? */
/* (POSIX.1b implementation for Linux) * /\| */
/* * / \ */
/* Created: 25-Aug-98 K.A. Knizhnik * / [] \ */
/* Last update: 27-Aug-98 K.A. Knizhnik * GARRET */
/*------------------------------------------------------------------*--------*/
/* Message queue implementation * */
/*------------------------------------------------------------------*--------*/
#include <unistd.h>
#include <string.h>
#include <fcntl.h>
#include <stdarg.h>
#include <alloca.h>
#include <errno.h>
#include <signal.h>
#include <sys/types.h>
#include <sys/ipc.h>
#include <sys/msg.h>
#include <sys/mman.h>
#ifndef MSGMAX
#define MSGMNI 128 /* <= 1K */ /* max # of msg queue identifiers */
#define MSGMAX 4056 /* <= 4056 */ /* max size of message (bytes) */
#endif
#include "rt_mq.h"
#define IMPLEMENT_MQ_NOTIFY 1 // support asynchronouse message receiving
mqd_t mq_open(const char *name, int oflag, ...)
{
key_t key = IPC_PRIVATE;
int msgid, fd = -1;
int mode = 0;
mqd_t q;
if (name != NULL) {
fd = open(name, O_RDWR|O_CREAT, 0777);
if (fd < 0) {
return (mqd_t)-1;
}
key = ftok(name, 0);
if (key < 0) {
return (mqd_t)-1;
}
}
if (oflag & O_CREAT) {
va_list ap;
va_start(ap, oflag);
mode = va_arg(ap, mode_t)|IPC_CREAT;
va_end(ap);
}
if (oflag & O_EXCL) {
mode |= IPC_EXCL;
}
msgid = msgget(key, mode);
if (msgid < 0) {
return (mqd_t)-1;
}
q = (mqd_t)malloc(sizeof(struct mq_descriptor));
q->msgid = msgid;
q->fd = fd;
q->flags = 0;
#if IMPLEMENT_MQ_NOTIFY
ftruncate(fd, sizeof(struct mq_notification_request));
q->req = (struct mq_notification_request*)
mmap(NULL, sizeof(struct mq_notification_request),
PROT_WRITE|PROT_READ, MAP_SHARED, fd, 0);
if (q->req == (struct mq_notification_request*)-1) {
q->req = NULL;
} else {
q->req->pid = 0;
}
#else
close(fd);
q->fd = -1;
q->req = NULL;
#endif
return q;
}
int mq_close(mqd_t mqdes)
{
if (mqdes->req != NULL) {
munmap((void*)mqdes->req, sizeof(struct mq_notification_request));
}
if (mqdes->fd >= 0) {
close(mqdes->fd);
}
free(mqdes);
return 0;
}
int mq_unlink(const char *name)
{
int key, msgid;
key = ftok(name, 0);
if (key < 0) {
return -1;
}
msgid = msgget(key, 0);
if (msgid < 0) {
return -1;
}
unlink(name);
return msgctl(msgid, IPC_RMID, 0);
}
int mq_notify(mqd_t mqdes, const struct sigevent *notification)
{
if (mqdes->req == NULL) {
errno = ENOENT;
return -1;
}
if (notification == NULL || notification->sigev_notify == SIGEV_NONE) {
mqdes->req->pid = 0;
} else if (notification->sigev_notify == SIGEV_SIGNAL) {
if (mqdes->req->pid != 0) {
errno = EBUSY;
return -1;
}
mqdes->req->pid = getpid();
mqdes->req->signo = notification->sigev_signo;
} else {
errno = EINVAL;
return -1;
}
return 0;
}
int mq_send(mqd_t mqdes, const char *msg_ptr, size_t msg_len,
unsigned int msg_prio)
{
struct msgbuf* buf;
int rc;
if (msg_prio > PWR_MQ_PRIO_MAX) {
errno = EINVAL;
return -1;
}
buf = (struct msgbuf*)alloca(msg_len + sizeof(long));
buf->mtype = PWR_MQ_PRIO_MAX - msg_prio;
memcpy(buf->mtext, msg_ptr, msg_len);
rc = msgsnd(mqdes->msgid, buf, msg_len, mqdes->flags);
if (rc == 0 && mqdes->req != NULL && mqdes->req->pid != 0) {
kill(mqdes->req->pid, mqdes->req->signo);
mqdes->req->pid = 0;
}
return 0;
}
ssize_t mq_receive(mqd_t mqdes, char *msg_ptr, size_t msg_len,
unsigned int *msg_prio)
{
struct msgbuf* buf = (struct msgbuf*)alloca(msg_len + sizeof(long));
ssize_t rc = msgrcv(mqdes->msgid, buf, msg_len,-PWR_MQ_PRIO_MAX, mqdes->flags);
if (msg_prio != NULL && rc >= 0) {
*msg_prio = PWR_MQ_PRIO_MAX - buf->mtype;
}
if (rc > 0) {
memcpy(msg_ptr, buf->mtext, rc);
}
return rc;
}
int mq_getattr(mqd_t mqdes, struct mq_attr *mqstat)
{
struct msqid_ds buf;
if (mqstat == NULL) {
errno = EINVAL;
return -1;
}
if (msgctl(mqdes->msgid, IPC_STAT, &buf) < 0) {
return -1;
}
mqstat->mq_maxmsg = MSGMNI; /* max # of messages allowed in MQ */
mqstat->mq_msgsize = MSGMAX; /* max size of any one message */
mqstat->mq_flags = (mqdes->flags & IPC_NOWAIT) ? O_NONBLOCK : 0;
mqstat->mq_curmsgs = buf.msg_qnum; /* # of messages currently on mq */
return 0;
}
int mq_setattr(mqd_t mqdes, const struct mq_attr *mqstat,
struct mq_attr *omqstat)
{
long oflags = mqdes->flags;
if (mqstat != NULL) {
mqdes->flags = (mqstat->mq_flags & O_NONBLOCK) ? IPC_NOWAIT : 0;
}
if (omqstat != NULL) {
struct msqid_ds buf;
if (msgctl(mqdes->msgid, IPC_STAT, &buf) < 0) {
return -1;
}
omqstat->mq_maxmsg = MSGMNI;
omqstat->mq_msgsize = MSGMAX;
omqstat->mq_flags = (oflags & IPC_NOWAIT) ? O_NONBLOCK : 0;
omqstat->mq_curmsgs = buf.msg_qnum;
}
return 0;
}
src/lib/rt/src/os_linux/rt_mq.h deleted 100644 → 0
View file @ b9ef9d81
/*
* Proview $Id: rt_mq.h,v 1.3 2005-12-13 15:14:27 claes Exp $
* Copyright (C) 2005 SSAB Oxelsund AB.
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License as
* published by the Free Software Foundation, either version 2 of
* the License, or (at your option) any later version.
*
* This program is distributed in the hope that it will be useful
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with the program, if not, write to the Free Software
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/
/*-< MQUEUE.H >-----------------------------------------------------*--------*/
/* POSIX.1b Version 1.0 (c) 1998 GARRET * ? */
/* (POSIX.1b implementation for Linux) * /\| */
/* * / \ */
/* Created: 25-Aug-98 K.A. Knizhnik * / [] \ */
/* Last update: 27-Aug-98 K.A. Knizhnik * GARRET */
/*------------------------------------------------------------------*--------*/
/* Message queue interface * */
/*------------------------------------------------------------------*--------*/
#ifndef rt_mq_h
#define rt_mq_h
#ifdef __cplusplus
extern "C" {
#endif
#include <stdlib.h>
struct mq_notification_request {
int pid;
int signo;
};
struct mq_descriptor {
int msgid;
int fd;
long flags;
struct mq_notification_request* req;
};
typedef struct mq_descriptor* mqd_t; /* Process-level message queue descriptor */
#define PWR_MQ_PRIO_MAX (256)
#define P4IPC_MSGSIZE 128 /* Implementation specified default size in bytes of
* a message. Used when attr is not specified by
* the user in mq_open().
*/
#define P4IPC_MAXMSG 64 /* Implementation specified number of messages
* in a queue. Used when attr is not specified
* by the user in mq_open().
*/
typedef struct mq_attr {
long mq_maxmsg; /* max # of messages allowed in MQ */
long mq_msgsize; /* max size of any one message */
long mq_flags; /* actions and state for mq operations */
long mq_curmsgs; /* # of messages currently on mq */
} mq_attr_t;
#ifndef SIGEV_SIGNAL
#define SIGEV_SIGNAL (0)
#define SIGEV_NONE (1)
union sigval {
int sival_int;
void* sival_ptr;
};
struct sigevent {
int sigev_notify;
int sigev_signo;
union sigval sigev_value;
};
#endif
mqd_t mq_open(const char *name, int oflag, ...);
int mq_close(mqd_t mqdes);
int mq_unlink(const char *name);
int mq_notify(mqd_t mqdes, const struct sigevent *notification);
int mq_send(mqd_t mqdes, const char *msg_ptr, size_t msg_len,
unsigned int msg_prio);
ssize_t mq_receive(mqd_t mqdes, char *msg_ptr, size_t msg_len,
unsigned int *msg_prio);
int mq_getattr(mqd_t mqdes, struct mq_attr *mqstat);
int mq_setattr(mqd_t mqdes, const struct mq_attr *mqstat,
struct mq_attr *omqstat);
#ifdef __cplusplus
}
#endif
#endif
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7