zomoe_msg_queue/mq_msg.c at master · Sim-szm/zomoe_msg_queue · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
/*
 * Copyright (C) 2014 zomoe
 *
 * zomoemq may be copied only under the terms of the GNU General Public License V3
 * mail  : xianszm007@gmail.com
 * Author: zomoe
 */
#include <stdlib.h>
#include <stdio.h>
#include <assert.h>
#include "mq_msg.h"

int buffer_to_header_t(const char *buffer, header_t *header){
    assert(buffer!=NULL && header!=NULL);
    header->protocol = *buffer;
    header->state = convert_buffer_to_int(buffer+1);
    header->bodylen = convert_buffer_to_long(buffer+1+sizeof(int));
    return 0;
}

int header_t_to_buffer(const header_t *header, char *buffer){
    assert(buffer!=NULL && header!=NULL);
    *buffer = header->protocol;
    convert_int_to_buffer(header->state,buffer+1);
    convert_long_to_buffer(header->bodylen,buffer+1+sizeof(int));
    return 0;
}

//the follow functions got from internet ,thanks much !

void convert_int_to_buffer(const int n, char *buffer){
    unsigned char *p_convert;
    p_convert = (unsigned char *)buffer;
    *p_convert++ = (n >> 24) & 0xFF;
    *p_convert++ = (n >> 16) & 0xFF;
    *p_convert++ = (n >> 8) & 0xFF;
    *p_convert++ = n & 0xFF;
}


int convert_buffer_to_int(const char *buffer){
    int convert_v;
    convert_v=(
             ((unsigned char)(*buffer)) << 24) |
            (((unsigned char)(*(buffer + 1)))<< 16) |
            (((unsigned char)(*(buffer + 2))) << 8) |
             ((unsigned char)(*(buffer + 3))
                )
            ;
    return convert_v;
}

void convert_long_to_buffer(int64_t n, char *buffer){
    unsigned char *p_convert;
    p_convert = (unsigned char *)buffer;
    *p_convert++ = (n >> 56) & 0xFF;
    *p_convert++ = (n >> 48) & 0xFF;
    *p_convert++ = (n >> 40) & 0xFF;
    *p_convert++ = (n >> 32) & 0xFF;
    *p_convert++ = (n >> 24) & 0xFF;
    *p_convert++ = (n >> 16) & 0xFF;
    *p_convert++ = (n >> 8) & 0xFF;
    *p_convert++ = n & 0xFF;
}

int64_t convert_buffer_to_long(const char *buffer){
    unsigned char *p_convert;
    p_convert = (unsigned char *)buffer;
    int64_t convert_v;
    convert_v=(
             ((int64_t) (*p_convert)) << 56) |
            (((int64_t) (*(p_convert + 1))) << 48) |
            (((int64_t) (*(p_convert + 2))) << 40) |
            (((int64_t) (*(p_convert + 3))) << 32) |
            (((int64_t) (*(p_convert + 4))) << 24) |
            (((int64_t) (*(p_convert + 5))) << 16) |
            (((int64_t) (*(p_convert + 6))) << 8)  |
             ((int64_t) (*(p_convert + 7))
                )
             ;
}