b62185f8c519ad37649278d987bbd8d64d6d8d36
[strongswan.git] / src / libcharon / network / sender.c
1 /*
2 * Copyright (C) 2012 Tobias Brunner
3 * Copyright (C) 2005-2006 Martin Willi
4 * Copyright (C) 2005 Jan Hutter
5 * Hochschule fuer Technik Rapperswil
6 *
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License as published by the
9 * Free Software Foundation; either version 2 of the License, or (at your
10 * option) any later version. See <http://www.fsf.org/copyleft/gpl.txt>.
11 *
12 * This program is distributed in the hope that it will be useful, but
13 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
14 * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
15 * for more details.
16 */
17
18 #include <unistd.h>
19 #include <stdlib.h>
20
21 #include "sender.h"
22
23 #include <daemon.h>
24 #include <network/socket.h>
25 #include <processing/jobs/callback_job.h>
26 #include <threading/thread.h>
27 #include <threading/condvar.h>
28 #include <threading/mutex.h>
29
30
31 typedef struct private_sender_t private_sender_t;
32
33 /**
34 * Private data of a sender_t object.
35 */
36 struct private_sender_t {
37 /**
38 * Public part of a sender_t object.
39 */
40 sender_t public;
41
42 /**
43 * The packets are stored in a linked list
44 */
45 linked_list_t *list;
46
47 /**
48 * mutex to synchronize access to list
49 */
50 mutex_t *mutex;
51
52 /**
53 * condvar to signal for packets added to list
54 */
55 condvar_t *got;
56
57 /**
58 * condvar to signal for packets sent
59 */
60 condvar_t *sent;
61
62 /**
63 * Delay for sending outgoing packets, to simulate larger RTT
64 */
65 int send_delay;
66
67 /**
68 * Specific message type to delay, 0 for any
69 */
70 int send_delay_type;
71
72 /**
73 * Delay request messages?
74 */
75 bool send_delay_request;
76
77 /**
78 * Delay response messages?
79 */
80 bool send_delay_response;
81 };
82
83 METHOD(sender_t, send_, void,
84 private_sender_t *this, packet_t *packet)
85 {
86 host_t *src, *dst;
87
88 src = packet->get_source(packet);
89 dst = packet->get_destination(packet);
90 DBG1(DBG_NET, "sending packet: from %#H to %#H", src, dst);
91
92 if (this->send_delay)
93 {
94 message_t *message;
95
96 message = message_create_from_packet(packet->clone(packet));
97 if (message->parse_header(message) == SUCCESS)
98 {
99 if (this->send_delay_type == 0 ||
100 this->send_delay_type == message->get_exchange_type(message))
101 {
102 if ((message->get_request(message) && this->send_delay_request) ||
103 (!message->get_request(message) && this->send_delay_response))
104 {
105 DBG1(DBG_NET, "using send delay: %dms", this->send_delay);
106 usleep(this->send_delay * 1000);
107 }
108 }
109 }
110 message->destroy(message);
111 }
112
113 this->mutex->lock(this->mutex);
114 this->list->insert_last(this->list, packet);
115 this->got->signal(this->got);
116 this->mutex->unlock(this->mutex);
117 }
118
119 /**
120 * Job callback function to send packets
121 */
122 static job_requeue_t send_packets(private_sender_t * this)
123 {
124 packet_t *packet;
125 host_t *src, *dst;
126 bool oldstate;
127
128 this->mutex->lock(this->mutex);
129 while (this->list->get_count(this->list) == 0)
130 {
131 /* add cleanup handler, wait for packet, remove cleanup handler */
132 thread_cleanup_push((thread_cleanup_t)this->mutex->unlock, this->mutex);
133 oldstate = thread_cancelability(TRUE);
134
135 this->got->wait(this->got, this->mutex);
136
137 thread_cancelability(oldstate);
138 thread_cleanup_pop(FALSE);
139 }
140 this->list->remove_first(this->list, (void**)&packet);
141 this->sent->signal(this->sent);
142 this->mutex->unlock(this->mutex);
143
144 /* if neither source nor destination port is 500 we add a Non-ESP marker */
145 dst = packet->get_destination(packet);
146 src = packet->get_source(packet);
147 if (dst->get_port(dst) != IKEV2_UDP_PORT &&
148 src->get_port(src) != IKEV2_UDP_PORT)
149 {
150 chunk_t marker = chunk_from_chars(0x00, 0x00, 0x00, 0x00), data;
151
152 data = packet->get_data(packet);
153 /* NAT keepalives have no marker prepended */
154 if (data.len != 1 || data.ptr[0] != 0xFF)
155 {
156 data = chunk_cat("cm", marker, data);
157 packet->set_data(packet, data);
158 }
159 }
160
161 charon->socket->send(charon->socket, packet);
162 packet->destroy(packet);
163 return JOB_REQUEUE_DIRECT;
164 }
165
166 METHOD(sender_t, flush, void,
167 private_sender_t *this)
168 {
169 /* send all packets in the queue */
170 this->mutex->lock(this->mutex);
171 while (this->list->get_count(this->list))
172 {
173 this->sent->wait(this->sent, this->mutex);
174 }
175 this->mutex->unlock(this->mutex);
176 }
177
178 METHOD(sender_t, destroy, void,
179 private_sender_t *this)
180 {
181 this->list->destroy_offset(this->list, offsetof(packet_t, destroy));
182 this->got->destroy(this->got);
183 this->sent->destroy(this->sent);
184 this->mutex->destroy(this->mutex);
185 free(this);
186 }
187
188 /*
189 * Described in header.
190 */
191 sender_t * sender_create()
192 {
193 private_sender_t *this;
194
195 INIT(this,
196 .public = {
197 .send = _send_,
198 .flush = _flush,
199 .destroy = _destroy,
200 },
201 .list = linked_list_create(),
202 .mutex = mutex_create(MUTEX_TYPE_DEFAULT),
203 .got = condvar_create(CONDVAR_TYPE_DEFAULT),
204 .sent = condvar_create(CONDVAR_TYPE_DEFAULT),
205 .send_delay = lib->settings->get_int(lib->settings,
206 "%s.send_delay", 0, charon->name),
207 .send_delay_type = lib->settings->get_int(lib->settings,
208 "%s.send_delay_type", 0, charon->name),
209 .send_delay_request = lib->settings->get_bool(lib->settings,
210 "%s.send_delay_request", TRUE, charon->name),
211 .send_delay_response = lib->settings->get_bool(lib->settings,
212 "%s.send_delay_response", TRUE, charon->name),
213 );
214
215 lib->processor->queue_job(lib->processor,
216 (job_t*)callback_job_create_with_prio((callback_job_cb_t)send_packets,
217 this, NULL, (callback_job_cancel_t)return_false, JOB_PRIO_CRITICAL));
218
219 return &this->public;
220 }
221