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
|
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include "stream.hpp"
char stx = 0x002;
char etx = 0x003;
struct stream* stream_create(){
struct stream* s = (struct stream*)malloc(sizeof(struct stream));
s->length = 0;
s->data = (byte*)malloc(sizeof(byte)*0);
s->read = 0;
return s;
}
void stream_writeInt(struct stream* s, int number){
long o = s->length;
s->length += sizeof(int);
s->data = (byte*)realloc(s->data,s->length);
int* ptr = (int*)(s->data + o);
*ptr = number;
}
int stream_readInt(struct stream* s){
int* ptr = (int*)(s->data + s->read);
s->read += sizeof(int);
return *ptr;
}
void stream_writeData(struct stream* s, const char* d, int len){
long o = s->length;
s->length += sizeof(char)*len;
s->data = (byte*)realloc(s->data,s->length);
char* ptr = (char*)(s->data + o);
memcpy(ptr,d,len);
}
void stream_readData(struct stream* s, int len, char* out){
char* ptr = (char*)(s->data + s->read);
memcpy(out,ptr,len);
s->read += len;
}
void stream_writeString(struct stream* s, const char* str, size_t len){
stream_writeData(s,str,len);
stream_writeData(s,"\0",1);//Null character
}
char* stream_readString(struct stream* s){
char* ptr = (char*)(s->data + s->read);
s->read += strlen(ptr) + 1;//+1 for null character
return ptr;
}
void stream_writeDouble(struct stream* s, double number){
long o = s->length;
s->length += sizeof(double);
s->data = (byte*)realloc(s->data,s->length);
double* ptr = (double*)(s->data + o);
*ptr = number;
}
void stream_print(struct stream* s){
printf("Length:%ld\nRead:%ld\nData starts at %p\nData:",s->length, s->read, s->data);
long i = 0;
byte* ptr = s->data;
while(i < s->length){
printf("%4X",*(ptr + i));
i++;
}
printf("\n");
}
void stream_free(struct stream* s){
free(s->data);
free(s);
}
|
