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
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
|
#include <baselib/system.h>
#include <baselib/network.h>
#include <cstdlib>
using namespace baselib;
struct packet
{
packet *prev;
packet *next;
netaddr4 send_to;
int64 timestamp;
int id;
int data_size;
char data[1];
};
static packet *first = (packet *)0;
static packet *last = (packet *)0;
static int current_latency = 0;
static int debug = 0;
int run(int port, netaddr4 dest)
{
netaddr4 src(0,0,0,0,0);
socket_udp4 socket;
socket.open(port);
char buffer[1024*2];
int id = 0;
while(1)
{
// handle incomming packets
while(1)
{
// fetch data
netaddr4 from;
int bytes = socket.recv(&from, buffer, 1024*2);
if(bytes <= 0)
break;
if((rand()%10) == 0) // drop the packet
continue;
// create new packet
packet *p = (packet *)mem_alloc(sizeof(packet)+bytes, 1);
if(from == dest)
p->send_to = src;
else
{
src = from;
p->send_to = dest;
}
// queue packet
p->prev = last;
p->next = 0;
if(last)
last->next = p;
else
{
first = p;
last = p;
}
last = p;
// set data in packet
p->timestamp = time_get();
p->data_size = bytes;
p->id = id++;
mem_copy(p->data, buffer, bytes);
if(debug)
dbg_msg("crapnet", "<< %08d %d.%d.%d.%d:%5d (%d)", p->id, from.ip[0], from.ip[1], from.ip[2], from.ip[3], from.port, p->data_size);
}
//
while(1)
{
//dbg_msg("crapnet", "%p", first);
if(first && (time_get()-first->timestamp) > current_latency)
{
packet *p = first;
first = first->next;
if(first)
first->prev = 0;
else
last = 0;
if(debug)
{
dbg_msg("crapnet", ">> %08d %d.%d.%d.%d:%5d (%d)", p->id,
p->send_to.ip[0], p->send_to.ip[1],
p->send_to.ip[2], p->send_to.ip[3],
p->send_to.port, p->data_size);
}
// send and remove packet
//if((rand()%10) != 0) // heavy packetloss
socket.send(&p->send_to, p->data, p->data_size);
// update lag
double flux = rand()/(double)RAND_MAX;
int ms_spike = 0;
int ms_flux = 20;
int ms_ping = 20;
current_latency = ((time_freq()*ms_ping)/1000) + (int64)(((time_freq()*ms_flux)/1000)*flux); // 50ms
if((p->id%100) == 0)
current_latency += (time_freq()*ms_spike)/1000;
mem_free(p);
}
else
break;
}
thread_sleep(1);
}
}
int main(int argc, char **argv)
{
run(8302, netaddr4(127,0,0,1,8303));
return 0;
}
|