source: mainline/uspace/srv/net/inetsrv/inetping.c@ ab6326bc

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since ab6326bc was 9749e47, checked in by Jiri Svoboda <jiri@…>, 12 years ago

ping6 - resistance is futile.
  • Property mode set to 100644
File size: 7.4 KB
Line 
1/*
2 * Copyright (c) 2013 Jiri Svoboda
3 * Copyright (c) 2013 Martin Decky
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 *
10 * - Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * - Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * - The name of the author may not be used to endorse or promote products
16 * derived from this software without specific prior written permission.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 */
29
30/** @addtogroup inet
31 * @{
32 */
33/**
34 * @file
35 * @brief
36 */
37
38#include <async.h>
39#include <errno.h>
40#include <fibril_synch.h>
41#include <io/log.h>
42#include <ipc/inet.h>
43#include <loc.h>
44#include <stdlib.h>
45#include <sys/types.h>
46#include <types/inetping.h>
47#include "icmp.h"
48#include "icmpv6.h"
49#include "icmp_std.h"
50#include "inetsrv.h"
51#include "inetping.h"
52
53static FIBRIL_MUTEX_INITIALIZE(client_list_lock);
54static LIST_INITIALIZE(client_list);
55
56/** Last used session identifier. Protected by @c client_list_lock */
57static uint16_t inetping_ident = 0;
58
59static int inetping_send(inetping_client_t *client, inetping_sdu_t *sdu)
60{
61 if (sdu->src.version != sdu->dest.version)
62 return EINVAL;
63
64 switch (sdu->src.version) {
65 case ip_v4:
66 return icmp_ping_send(client->ident, sdu);
67 case ip_v6:
68 return icmpv6_ping_send(client->ident, sdu);
69 default:
70 return EINVAL;
71 }
72}
73
74static int inetping_get_srcaddr(inetping_client_t *client,
75 inet_addr_t *remote, inet_addr_t *local)
76{
77 return inet_get_srcaddr(remote, ICMP_TOS, local);
78}
79
80static inetping_client_t *inetping_client_find(uint16_t ident)
81{
82 fibril_mutex_lock(&client_list_lock);
83
84 list_foreach(client_list, client_list, inetping_client_t, client) {
85 if (client->ident == ident) {
86 fibril_mutex_unlock(&client_list_lock);
87 return client;
88 }
89 }
90
91 fibril_mutex_unlock(&client_list_lock);
92 return NULL;
93}
94
95int inetping_recv(uint16_t ident, inetping_sdu_t *sdu)
96{
97 inetping_client_t *client = inetping_client_find(ident);
98 if (client == NULL) {
99 log_msg(LOG_DEFAULT, LVL_DEBUG, "Unknown ICMP ident. Dropping.");
100 return ENOENT;
101 }
102
103 async_exch_t *exch = async_exchange_begin(client->sess);
104
105 ipc_call_t answer;
106 aid_t req = async_send_1(exch, INETPING_EV_RECV, sdu->seq_no, &answer);
107
108 int rc = async_data_write_start(exch, &sdu->src, sizeof(sdu->src));
109 if (rc != EOK) {
110 async_exchange_end(exch);
111 async_forget(req);
112 return rc;
113 }
114
115 rc = async_data_write_start(exch, &sdu->dest, sizeof(sdu->dest));
116 if (rc != EOK) {
117 async_exchange_end(exch);
118 async_forget(req);
119 return rc;
120 }
121
122 rc = async_data_write_start(exch, sdu->data, sdu->size);
123
124 async_exchange_end(exch);
125
126 if (rc != EOK) {
127 async_forget(req);
128 return rc;
129 }
130
131 sysarg_t retval;
132 async_wait_for(req, &retval);
133
134 return (int) retval;
135}
136
137static void inetping_send_srv(inetping_client_t *client, ipc_callid_t iid,
138 ipc_call_t *icall)
139{
140 log_msg(LOG_DEFAULT, LVL_DEBUG, "inetping_send_srv()");
141
142 inetping_sdu_t sdu;
143 int rc;
144
145 sdu.seq_no = IPC_GET_ARG1(*icall);
146
147 ipc_callid_t callid;
148 size_t size;
149 if (!async_data_write_receive(&callid, &size)) {
150 async_answer_0(callid, EREFUSED);
151 async_answer_0(iid, EREFUSED);
152 return;
153 }
154
155 if (size != sizeof(sdu.src)) {
156 async_answer_0(callid, EINVAL);
157 async_answer_0(iid, EINVAL);
158 return;
159 }
160
161 rc = async_data_write_finalize(callid, &sdu.src, size);
162 if (rc != EOK) {
163 async_answer_0(callid, rc);
164 async_answer_0(iid, rc);
165 return;
166 }
167
168 if (!async_data_write_receive(&callid, &size)) {
169 async_answer_0(callid, EREFUSED);
170 async_answer_0(iid, EREFUSED);
171 return;
172 }
173
174 if (size != sizeof(sdu.dest)) {
175 async_answer_0(callid, EINVAL);
176 async_answer_0(iid, EINVAL);
177 return;
178 }
179
180 rc = async_data_write_finalize(callid, &sdu.dest, size);
181 if (rc != EOK) {
182 async_answer_0(callid, rc);
183 async_answer_0(iid, rc);
184 return;
185 }
186
187 rc = async_data_write_accept((void **) &sdu.data, false, 0, 0, 0,
188 &sdu.size);
189 if (rc != EOK) {
190 async_answer_0(iid, rc);
191 return;
192 }
193
194 rc = inetping_send(client, &sdu);
195 free(sdu.data);
196
197 async_answer_0(iid, rc);
198}
199
200static void inetping_get_srcaddr_srv(inetping_client_t *client,
201 ipc_callid_t iid, ipc_call_t *icall)
202{
203 log_msg(LOG_DEFAULT, LVL_DEBUG, "inetping_get_srcaddr_srv()");
204
205 ipc_callid_t callid;
206 size_t size;
207
208 inet_addr_t local;
209 inet_addr_t remote;
210
211 if (!async_data_write_receive(&callid, &size)) {
212 async_answer_0(callid, EREFUSED);
213 async_answer_0(iid, EREFUSED);
214 return;
215 }
216
217 if (size != sizeof(remote)) {
218 async_answer_0(callid, EINVAL);
219 async_answer_0(iid, EINVAL);
220 return;
221 }
222
223 int rc = async_data_write_finalize(callid, &remote, size);
224 if (rc != EOK) {
225 async_answer_0(callid, rc);
226 async_answer_0(iid, rc);
227 return;
228 }
229
230 rc = inetping_get_srcaddr(client, &remote, &local);
231 if (rc != EOK) {
232 async_answer_0(iid, rc);
233 return;
234 }
235
236 if (!async_data_read_receive(&callid, &size)) {
237 async_answer_0(callid, EREFUSED);
238 async_answer_0(iid, EREFUSED);
239 return;
240 }
241
242 if (size != sizeof(local)) {
243 async_answer_0(callid, EINVAL);
244 async_answer_0(iid, EINVAL);
245 return;
246 }
247
248 rc = async_data_read_finalize(callid, &local, size);
249 if (rc != EOK)
250 async_answer_0(callid, rc);
251
252 async_answer_0(iid, rc);
253}
254
255static int inetping_client_init(inetping_client_t *client)
256{
257 async_sess_t *sess = async_callback_receive(EXCHANGE_SERIALIZE);
258 if (sess == NULL)
259 return ENOMEM;
260
261 client->sess = sess;
262 link_initialize(&client->client_list);
263
264 fibril_mutex_lock(&client_list_lock);
265 client->ident = ++inetping_ident;
266 list_append(&client->client_list, &client_list);
267 fibril_mutex_unlock(&client_list_lock);
268
269 return EOK;
270}
271
272static void inetping_client_fini(inetping_client_t *client)
273{
274 async_hangup(client->sess);
275 client->sess = NULL;
276
277 fibril_mutex_lock(&client_list_lock);
278 list_remove(&client->client_list);
279 fibril_mutex_unlock(&client_list_lock);
280}
281
282void inetping_conn(ipc_callid_t iid, ipc_call_t *icall, void *arg)
283{
284 log_msg(LOG_DEFAULT, LVL_DEBUG, "inetping_conn()");
285
286 /* Accept the connection */
287 async_answer_0(iid, EOK);
288
289 inetping_client_t client;
290 int rc = inetping_client_init(&client);
291 if (rc != EOK)
292 return;
293
294 while (true) {
295 ipc_call_t call;
296 ipc_callid_t callid = async_get_call(&call);
297 sysarg_t method = IPC_GET_IMETHOD(call);
298
299 if (!method) {
300 /* The other side has hung up */
301 async_answer_0(callid, EOK);
302 break;
303 }
304
305 switch (method) {
306 case INETPING_SEND:
307 inetping_send_srv(&client, callid, &call);
308 break;
309 case INETPING_GET_SRCADDR:
310 inetping_get_srcaddr_srv(&client, callid, &call);
311 break;
312 default:
313 async_answer_0(callid, EINVAL);
314 }
315 }
316
317 inetping_client_fini(&client);
318}
319
320/** @}
321 */
Note: See TracBrowser for help on using the repository browser.