Obsolete
/
libipc-old
Archived
3
0
Fork 0
This repository has been archived on 2024-06-18. You can view files and clone it, but cannot push or open issues/pull-requests.
libipc-old/core/msg.c

171 lines
3.3 KiB
C
Raw Normal View History

2016-12-21 01:26:47 +01:00
#include "msg.h"
#include "error.h"
#include "usocket.h"
#include <assert.h>
void print_msg (const struct msg *m)
{
assert (m != NULL);
printf ("msg: type %d len %d\n", m->type, m->valsize);
}
2016-12-21 01:26:47 +01:00
int msg_format_read (struct msg *m, const char *buf, size_t msize)
{
assert (m != NULL);
assert (buf != NULL);
assert (msize <= BUFSIZ - 3);
if (m == NULL)
return -1;
m->type = buf[0];
memcpy (&m->valsize, buf+1, 2);
assert (m->valsize <= BUFSIZ -3);
// printf ("type %d : msize = %ld, valsize = %d\n", m->type, msize, m->valsize);
assert (m->valsize == msize - 3);
2016-12-21 01:26:47 +01:00
if (m->val != NULL)
free (m->val), m->val = NULL;
if (m->val == NULL && m->valsize > 0) {
2016-12-21 01:26:47 +01:00
m->val = malloc (m->valsize);
memcpy (m->val, buf+3, m->valsize);
}
return 0;
}
int msg_format_write (const struct msg *m, char **buf, size_t *msize)
2016-12-21 01:26:47 +01:00
{
assert (m != NULL);
assert (buf != NULL);
assert (msize != NULL);
assert (m->valsize <= BUFSIZ -3);
if (m == NULL)
return -1;
if (buf == NULL)
return -2;
if (msize == NULL)
return -3;
if (*buf == NULL) {
*buf = malloc (3 + m->valsize);
}
2016-12-21 01:26:47 +01:00
char *buffer = *buf;
buffer[0] = m->type;
memcpy (buffer + 1, &m->valsize, 2);
memcpy (buffer + 3, m->val, m->valsize);
*msize = 3 + m->valsize;
2016-12-21 01:26:47 +01:00
return 0;
}
int msg_read (int fd, struct msg *m)
{
assert (m != NULL);
char *buf = NULL;
size_t msize = BUFSIZ;
2016-12-21 01:26:47 +01:00
int ret = usock_recv (fd, &buf, &msize);
if (ret < 0) {
handle_err ("msg_read", "usock_recv");
return ret;
}
if (msg_format_read (m, buf, msize) < 0) {
return -1;
}
free (buf);
// printf ("msg received: ");
// print_msg (m);
2016-12-21 01:26:47 +01:00
return 0;
}
int msg_write (int fd, const struct msg *m)
{
assert (m != NULL);
// printf ("msg to write: ");
// print_msg (m);
2016-12-21 01:26:47 +01:00
char *buf = NULL;
size_t msize = 0;
msg_format_write (m, &buf, &msize);
// printf ("msg to send, real size %ld\n", msize);
2016-12-21 01:26:47 +01:00
int ret = usock_send (fd, buf, msize);
if (ret < 0) {
handle_err ("msg_write", "usock_send");
return ret;
}
if (buf != NULL)
free (buf);
return 0;
}
// MSG FORMAT
int msg_format (struct msg *m, char type, const char *val, size_t valsize)
{
assert (m != NULL);
assert (valsize + 3 <= BUFSIZ);
assert ((valsize == 0 && val == NULL) || (valsize > 0 && val != NULL));
2016-12-21 01:26:47 +01:00
if (valsize + 3 > BUFSIZ) {
handle_err ("msg_format_con", "msgsize > BUFSIZ");
return -1;
}
m->type = type;
m->valsize = (short) valsize;
if (m->val == NULL)
m->val = malloc (valsize);
2016-12-21 01:26:47 +01:00
memcpy (m->val, val, valsize);
return 0;
}
int msg_format_con (struct msg *m, const char *val, size_t valsize)
{
return msg_format (m, MSG_TYPE_CON, val, valsize);
}
int msg_format_data (struct msg *m, const char *val, size_t valsize)
{
return msg_format (m, MSG_TYPE_DATA, val, valsize);
}
int msg_format_ack (struct msg *m, const char *val, size_t valsize)
{
return msg_format (m, MSG_TYPE_ACK, val, valsize);
}
int msg_free (struct msg *m)
{
assert (m != NULL);
if (m == NULL)
return -1;
if (m->val != NULL)
free (m->val), m->val = NULL;
m->valsize = 0;
2016-12-21 01:26:47 +01:00
return 0;
}