source: mainline/uspace/srv/net/tl/udp/udp.c@ aaa3f33a

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

Remove xxx_ref typedefs (part 5).
  • Property mode set to 100644
File size: 25.6 KB
Line 
1/*
2 * Copyright (c) 2008 Lukas Mejdrech
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 *
9 * - Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * - Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * - The name of the author may not be used to endorse or promote products
15 * derived from this software without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 */
28
29/** @addtogroup udp
30 * @{
31 */
32
33/** @file
34 * UDP module implementation.
35 * @see udp.h
36 */
37
38#include "udp.h"
39#include "udp_header.h"
40#include "udp_module.h"
41
42#include <async.h>
43#include <fibril_synch.h>
44#include <malloc.h>
45#include <stdio.h>
46#include <ipc/ipc.h>
47#include <ipc/services.h>
48#include <ipc/net.h>
49#include <ipc/tl.h>
50#include <ipc/socket.h>
51#include <adt/dynamic_fifo.h>
52#include <errno.h>
53
54#include <net/socket_codes.h>
55#include <net/ip_protocols.h>
56#include <net/in.h>
57#include <net/in6.h>
58#include <net/inet.h>
59#include <net/modules.h>
60
61#include <packet_client.h>
62#include <packet_remote.h>
63#include <net_checksum.h>
64#include <ip_client.h>
65#include <ip_interface.h>
66#include <icmp_client.h>
67#include <icmp_interface.h>
68#include <net_interface.h>
69#include <socket_core.h>
70#include <tl_common.h>
71#include <tl_local.h>
72#include <tl_interface.h>
73
74/** UDP module name. */
75#define NAME "UDP protocol"
76
77/** Default UDP checksum computing. */
78#define NET_DEFAULT_UDP_CHECKSUM_COMPUTING true
79
80/** Default UDP autobind when sending via unbound sockets. */
81#define NET_DEFAULT_UDP_AUTOBINDING true
82
83/** Maximum UDP fragment size. */
84#define MAX_UDP_FRAGMENT_SIZE 65535
85
86/** Free ports pool start. */
87#define UDP_FREE_PORTS_START 1025
88
89/** Free ports pool end. */
90#define UDP_FREE_PORTS_END 65535
91
92/** UDP global data. */
93udp_globals_t udp_globals;
94
95/** Initializes the UDP module.
96 *
97 * @param[in] client_connection The client connection processing function. The
98 * module skeleton propagates its own one.
99 * @returns EOK on success.
100 * @returns ENOMEM if there is not enough memory left.
101 */
102int udp_initialize(async_client_conn_t client_connection)
103{
104 measured_string_t names[] = {
105 {
106 (char *) "UDP_CHECKSUM_COMPUTING",
107 22
108 },
109 {
110 (char *) "UDP_AUTOBINDING",
111 15
112 }
113 };
114 measured_string_t *configuration;
115 size_t count = sizeof(names) / sizeof(measured_string_t);
116 char *data;
117 int rc;
118
119 fibril_rwlock_initialize(&udp_globals.lock);
120 fibril_rwlock_write_lock(&udp_globals.lock);
121
122 udp_globals.icmp_phone = icmp_connect_module(SERVICE_ICMP,
123 ICMP_CONNECT_TIMEOUT);
124
125 udp_globals.ip_phone = ip_bind_service(SERVICE_IP, IPPROTO_UDP,
126 SERVICE_UDP, client_connection);
127 if (udp_globals.ip_phone < 0) {
128 fibril_rwlock_write_unlock(&udp_globals.lock);
129 return udp_globals.ip_phone;
130 }
131
132 /* Read default packet dimensions */
133 rc = ip_packet_size_req(udp_globals.ip_phone, -1,
134 &udp_globals.packet_dimension);
135 if (rc != EOK) {
136 fibril_rwlock_write_unlock(&udp_globals.lock);
137 return rc;
138 }
139
140 rc = socket_ports_initialize(&udp_globals.sockets);
141 if (rc != EOK) {
142 fibril_rwlock_write_unlock(&udp_globals.lock);
143 return rc;
144 }
145
146 rc = packet_dimensions_initialize(&udp_globals.dimensions);
147 if (rc != EOK) {
148 socket_ports_destroy(&udp_globals.sockets);
149 fibril_rwlock_write_unlock(&udp_globals.lock);
150 return rc;
151 }
152
153 udp_globals.packet_dimension.prefix += sizeof(udp_header_t);
154 udp_globals.packet_dimension.content -= sizeof(udp_header_t);
155 udp_globals.last_used_port = UDP_FREE_PORTS_START - 1;
156
157 udp_globals.checksum_computing = NET_DEFAULT_UDP_CHECKSUM_COMPUTING;
158 udp_globals.autobinding = NET_DEFAULT_UDP_AUTOBINDING;
159
160 /* Get configuration */
161 configuration = &names[0];
162 rc = net_get_conf_req(udp_globals.net_phone, &configuration, count,
163 &data);
164 if (rc != EOK) {
165 socket_ports_destroy(&udp_globals.sockets);
166 fibril_rwlock_write_unlock(&udp_globals.lock);
167 return rc;
168 }
169
170 if (configuration) {
171 if (configuration[0].value)
172 udp_globals.checksum_computing =
173 (configuration[0].value[0] == 'y');
174
175 if (configuration[1].value)
176 udp_globals.autobinding =
177 (configuration[1].value[0] == 'y');
178
179 net_free_settings(configuration, data);
180 }
181
182 fibril_rwlock_write_unlock(&udp_globals.lock);
183 return EOK;
184}
185
186/** Releases the packet and returns the result.
187 *
188 * @param[in] packet The packet queue to be released.
189 * @param[in] result The result to be returned.
190 * @return The result parameter.
191 */
192static int udp_release_and_return(packet_t packet, int result)
193{
194 pq_release_remote(udp_globals.net_phone, packet_get_id(packet));
195 return result;
196}
197
198/** Processes the received UDP packet queue.
199 *
200 * Notifies the destination socket application.
201 * Releases the packet on error or sends an ICMP error notification.
202 *
203 * @param[in] device_id The receiving device identifier.
204 * @param[in,out] packet The received packet queue.
205 * @param[in] error The packet error reporting service. Prefixes the
206 * received packet.
207 * @returns EOK on success.
208 * @returns EINVAL if the packet is not valid.
209 * @returns EINVAL if the stored packet address is not the
210 * an_addr_t.
211 * @returns EINVAL if the packet does not contain any data.
212 * @returns NO_DATA if the packet content is shorter than the user
213 * datagram header.
214 * @returns ENOMEM if there is not enough memory left.
215 * @returns EADDRNOTAVAIL if the destination socket does not exist.
216 * @returns Other error codes as defined for the
217 * ip_client_process_packet() function.
218 */
219static int udp_process_packet(device_id_t device_id, packet_t packet,
220 services_t error)
221{
222 size_t length;
223 size_t offset;
224 int result;
225 udp_header_t *header;
226 socket_core_t *socket;
227 packet_t next_packet;
228 size_t total_length;
229 uint32_t checksum;
230 int fragments;
231 packet_t tmp_packet;
232 icmp_type_t type;
233 icmp_code_t code;
234 void *ip_header;
235 struct sockaddr *src;
236 struct sockaddr *dest;
237 packet_dimension_t *packet_dimension;
238 int rc;
239
240 switch (error) {
241 case SERVICE_NONE:
242 break;
243 case SERVICE_ICMP:
244 /* Ignore error */
245 // length = icmp_client_header_length(packet);
246
247 /* Process error */
248 result = icmp_client_process_packet(packet, &type,
249 &code, NULL, NULL);
250 if (result < 0)
251 return udp_release_and_return(packet, result);
252 length = (size_t) result;
253 rc = packet_trim(packet, length, 0);
254 if (rc != EOK)
255 return udp_release_and_return(packet, rc);
256 break;
257 default:
258 return udp_release_and_return(packet, ENOTSUP);
259 }
260
261 /* TODO process received ipopts? */
262 result = ip_client_process_packet(packet, NULL, NULL, NULL, NULL, NULL);
263 if (result < 0)
264 return udp_release_and_return(packet, result);
265 offset = (size_t) result;
266
267 length = packet_get_data_length(packet);
268 if (length <= 0)
269 return udp_release_and_return(packet, EINVAL);
270 if (length < UDP_HEADER_SIZE + offset)
271 return udp_release_and_return(packet, NO_DATA);
272
273 /* Trim all but UDP header */
274 rc = packet_trim(packet, offset, 0);
275 if (rc != EOK)
276 return udp_release_and_return(packet, rc);
277
278 /* Get UDP header */
279 header = (udp_header_t *) packet_get_data(packet);
280 if (!header)
281 return udp_release_and_return(packet, NO_DATA);
282
283 /* Find the destination socket */
284 socket = socket_port_find(&udp_globals.sockets,
285 ntohs(header->destination_port), SOCKET_MAP_KEY_LISTENING, 0);
286 if (!socket) {
287 if (tl_prepare_icmp_packet(udp_globals.net_phone,
288 udp_globals.icmp_phone, packet, error) == EOK) {
289 icmp_destination_unreachable_msg(udp_globals.icmp_phone,
290 ICMP_PORT_UNREACH, 0, packet);
291 }
292 return EADDRNOTAVAIL;
293 }
294
295 /* Count the received packet fragments */
296 next_packet = packet;
297 fragments = 0;
298 total_length = ntohs(header->total_length);
299
300 /* Compute header checksum if set */
301 if (header->checksum && !error) {
302 result = packet_get_addr(packet, (uint8_t **) &src,
303 (uint8_t **) &dest);
304 if (result <= 0)
305 return udp_release_and_return(packet, result);
306
307 rc = ip_client_get_pseudo_header(IPPROTO_UDP, src, result, dest,
308 result, total_length, &ip_header, &length);
309 if (rc != EOK) {
310 return udp_release_and_return(packet, rc);
311 } else {
312 checksum = compute_checksum(0, ip_header, length);
313 /*
314 * The udp header checksum will be added with the first
315 * fragment later.
316 */
317 free(ip_header);
318 }
319 } else {
320 header->checksum = 0;
321 checksum = 0;
322 }
323
324 do {
325 fragments++;
326 length = packet_get_data_length(next_packet);
327 if (length <= 0)
328 return udp_release_and_return(packet, NO_DATA);
329
330 if (total_length < length) {
331 rc = packet_trim(next_packet, 0, length - total_length);
332 if (rc != EOK)
333 return udp_release_and_return(packet, rc);
334
335 /* Add partial checksum if set */
336 if (header->checksum) {
337 checksum = compute_checksum(checksum,
338 packet_get_data(packet),
339 packet_get_data_length(packet));
340 }
341
342 /* Relese the rest of the packet fragments */
343 tmp_packet = pq_next(next_packet);
344 while (tmp_packet) {
345 next_packet = pq_detach(tmp_packet);
346 pq_release_remote(udp_globals.net_phone,
347 packet_get_id(tmp_packet));
348 tmp_packet = next_packet;
349 }
350
351 /* Exit the loop */
352 break;
353 }
354 total_length -= length;
355
356 /* Add partial checksum if set */
357 if (header->checksum) {
358 checksum = compute_checksum(checksum,
359 packet_get_data(packet),
360 packet_get_data_length(packet));
361 }
362
363 } while ((next_packet = pq_next(next_packet)) && (total_length > 0));
364
365 /* Verify checksum */
366 if (header->checksum) {
367 if (flip_checksum(compact_checksum(checksum)) !=
368 IP_CHECKSUM_ZERO) {
369 if (tl_prepare_icmp_packet(udp_globals.net_phone,
370 udp_globals.icmp_phone, packet, error) == EOK) {
371 /* Checksum error ICMP */
372 icmp_parameter_problem_msg(
373 udp_globals.icmp_phone, ICMP_PARAM_POINTER,
374 ((size_t) ((void *) &header->checksum)) -
375 ((size_t) ((void *) header)), packet);
376 }
377 return EINVAL;
378 }
379 }
380
381 /* Queue the received packet */
382 rc = dyn_fifo_push(&socket->received, packet_get_id(packet),
383 SOCKET_MAX_RECEIVED_SIZE);
384 if (rc != EOK)
385 return udp_release_and_return(packet, rc);
386
387 rc = tl_get_ip_packet_dimension(udp_globals.ip_phone,
388 &udp_globals.dimensions, device_id, &packet_dimension);
389 if (rc != EOK)
390 return udp_release_and_return(packet, rc);
391
392 /* Notify the destination socket */
393 fibril_rwlock_write_unlock(&udp_globals.lock);
394 async_msg_5(socket->phone, NET_SOCKET_RECEIVED,
395 (ipcarg_t) socket->socket_id, packet_dimension->content, 0, 0,
396 (ipcarg_t) fragments);
397
398 return EOK;
399}
400
401/** Processes the received UDP packet queue.
402 *
403 * Is used as an entry point from the underlying IP module.
404 * Locks the global lock and calls udp_process_packet() function.
405 *
406 * @param[in] device_id The receiving device identifier.
407 * @param[in,out] packet The received packet queue.
408 * @param receiver The target service. Ignored parameter.
409 * @param[in] error The packet error reporting service. Prefixes the
410 * received packet.
411 * @returns EOK on success.
412 * @returns Other error codes as defined for the
413 * udp_process_packet() function.
414 */
415static int udp_received_msg(device_id_t device_id, packet_t packet,
416 services_t receiver, services_t error)
417{
418 int result;
419
420 fibril_rwlock_write_lock(&udp_globals.lock);
421 result = udp_process_packet(device_id, packet, error);
422 if (result != EOK)
423 fibril_rwlock_write_unlock(&udp_globals.lock);
424
425 return result;
426}
427
428/** Sends data from the socket to the remote address.
429 *
430 * Binds the socket to a free port if not already connected/bound.
431 * Handles the NET_SOCKET_SENDTO message.
432 * Supports AF_INET and AF_INET6 address families.
433 *
434 * @param[in,out] local_sockets The application local sockets.
435 * @param[in] socket_id Socket identifier.
436 * @param[in] addr The destination address.
437 * @param[in] addrlen The address length.
438 * @param[in] fragments The number of data fragments.
439 * @param[out] data_fragment_size The data fragment size in bytes.
440 * @param[in] flags Various send flags.
441 * @returns EOK on success.
442 * @returns EAFNOTSUPPORT if the address family is not supported.
443 * @returns ENOTSOCK if the socket is not found.
444 * @returns EINVAL if the address is invalid.
445 * @returns ENOTCONN if the sending socket is not and cannot be
446 * bound.
447 * @returns ENOMEM if there is not enough memory left.
448 * @returns Other error codes as defined for the
449 * socket_read_packet_data() function.
450 * @returns Other error codes as defined for the
451 * ip_client_prepare_packet() function.
452 * @returns Other error codes as defined for the ip_send_msg()
453 * function.
454 */
455static int udp_sendto_message(socket_cores_t *local_sockets, int socket_id,
456 const struct sockaddr *addr, socklen_t addrlen, int fragments,
457 size_t *data_fragment_size, int flags)
458{
459 socket_core_t *socket;
460 packet_t packet;
461 packet_t next_packet;
462 udp_header_t *header;
463 int index;
464 size_t total_length;
465 int result;
466 uint16_t dest_port;
467 uint32_t checksum;
468 void *ip_header;
469 size_t headerlen;
470 device_id_t device_id;
471 packet_dimension_t *packet_dimension;
472 int rc;
473
474 rc = tl_get_address_port(addr, addrlen, &dest_port);
475 if (rc != EOK)
476 return rc;
477
478 socket = socket_cores_find(local_sockets, socket_id);
479 if (!socket)
480 return ENOTSOCK;
481
482 if ((socket->port <= 0) && udp_globals.autobinding) {
483 /* Bind the socket to a random free port if not bound */
484 rc = socket_bind_free_port(&udp_globals.sockets, socket,
485 UDP_FREE_PORTS_START, UDP_FREE_PORTS_END,
486 udp_globals.last_used_port);
487 if (rc != EOK)
488 return rc;
489 /* Set the next port as the search starting port number */
490 udp_globals.last_used_port = socket->port;
491 }
492
493 if (udp_globals.checksum_computing) {
494 rc = ip_get_route_req(udp_globals.ip_phone, IPPROTO_UDP, addr,
495 addrlen, &device_id, &ip_header, &headerlen);
496 if (rc != EOK)
497 return rc;
498 /* Get the device packet dimension */
499// rc = tl_get_ip_packet_dimension(udp_globals.ip_phone,
500// &udp_globals.dimensions, device_id, &packet_dimension);
501// if (rc != EOK)
502// return rc;
503 }
504// } else {
505 /* Do not ask all the time */
506 rc = ip_packet_size_req(udp_globals.ip_phone, -1,
507 &udp_globals.packet_dimension);
508 if (rc != EOK)
509 return rc;
510 packet_dimension = &udp_globals.packet_dimension;
511// }
512
513 /* Read the first packet fragment */
514 result = tl_socket_read_packet_data(udp_globals.net_phone, &packet,
515 UDP_HEADER_SIZE, packet_dimension, addr, addrlen);
516 if (result < 0)
517 return result;
518
519 total_length = (size_t) result;
520 if (udp_globals.checksum_computing)
521 checksum = compute_checksum(0, packet_get_data(packet),
522 packet_get_data_length(packet));
523 else
524 checksum = 0;
525
526 /* Prefix the UDP header */
527 header = PACKET_PREFIX(packet, udp_header_t);
528 if (!header)
529 return udp_release_and_return(packet, ENOMEM);
530
531 bzero(header, sizeof(*header));
532
533 /* Read the rest of the packet fragments */
534 for (index = 1; index < fragments; index++) {
535 result = tl_socket_read_packet_data(udp_globals.net_phone,
536 &next_packet, 0, packet_dimension, addr, addrlen);
537 if (result < 0)
538 return udp_release_and_return(packet, result);
539
540 rc = pq_add(&packet, next_packet, index, 0);
541 if (rc != EOK)
542 return udp_release_and_return(packet, rc);
543
544 total_length += (size_t) result;
545 if (udp_globals.checksum_computing) {
546 checksum = compute_checksum(checksum,
547 packet_get_data(next_packet),
548 packet_get_data_length(next_packet));
549 }
550 }
551
552 /* Set the UDP header */
553 header->source_port = htons((socket->port > 0) ? socket->port : 0);
554 header->destination_port = htons(dest_port);
555 header->total_length = htons(total_length + sizeof(*header));
556 header->checksum = 0;
557
558 if (udp_globals.checksum_computing) {
559 /* Update the pseudo header */
560 rc = ip_client_set_pseudo_header_data_length(ip_header,
561 headerlen, total_length + UDP_HEADER_SIZE);
562 if (rc != EOK) {
563 free(ip_header);
564 return udp_release_and_return(packet, rc);
565 }
566
567 /* Finish the checksum computation */
568 checksum = compute_checksum(checksum, ip_header, headerlen);
569 checksum = compute_checksum(checksum, (uint8_t *) header,
570 sizeof(*header));
571 header->checksum =
572 htons(flip_checksum(compact_checksum(checksum)));
573 free(ip_header);
574 } else {
575 device_id = DEVICE_INVALID_ID;
576 }
577
578 /* Prepare the first packet fragment */
579 rc = ip_client_prepare_packet(packet, IPPROTO_UDP, 0, 0, 0, 0);
580 if (rc != EOK)
581 return udp_release_and_return(packet, rc);
582
583 /* Release the UDP global lock on success. */
584 fibril_rwlock_write_unlock(&udp_globals.lock);
585
586 /* Send the packet */
587 ip_send_msg(udp_globals.ip_phone, device_id, packet, SERVICE_UDP, 0);
588
589 return EOK;
590}
591
592/** Receives data to the socket.
593 *
594 * Handles the NET_SOCKET_RECVFROM message.
595 * Replies the source address as well.
596 *
597 * @param[in] local_sockets The application local sockets.
598 * @param[in] socket_id Socket identifier.
599 * @param[in] flags Various receive flags.
600 * @param[out] addrlen The source address length.
601 * @returns The number of bytes received.
602 * @returns ENOTSOCK if the socket is not found.
603 * @returns NO_DATA if there are no received packets or data.
604 * @returns ENOMEM if there is not enough memory left.
605 * @returns EINVAL if the received address is not an IP address.
606 * @returns Other error codes as defined for the packet_translate()
607 * function.
608 * @returns Other error codes as defined for the data_reply()
609 * function.
610 */
611static int udp_recvfrom_message(socket_cores_t *local_sockets, int socket_id,
612 int flags, size_t *addrlen)
613{
614 socket_core_t *socket;
615 int packet_id;
616 packet_t packet;
617 udp_header_t *header;
618 struct sockaddr *addr;
619 size_t length;
620 uint8_t *data;
621 int result;
622 int rc;
623
624 /* Find the socket */
625 socket = socket_cores_find(local_sockets, socket_id);
626 if (!socket)
627 return ENOTSOCK;
628
629 /* Get the next received packet */
630 packet_id = dyn_fifo_value(&socket->received);
631 if (packet_id < 0)
632 return NO_DATA;
633
634 rc = packet_translate_remote(udp_globals.net_phone, &packet, packet_id);
635 if (rc != EOK) {
636 (void) dyn_fifo_pop(&socket->received);
637 return rc;
638 }
639
640 /* Get UDP header */
641 data = packet_get_data(packet);
642 if (!data) {
643 (void) dyn_fifo_pop(&socket->received);
644 return udp_release_and_return(packet, NO_DATA);
645 }
646 header = (udp_header_t *) data;
647
648 /* Set the source address port */
649 result = packet_get_addr(packet, (uint8_t **) &addr, NULL);
650 rc = tl_set_address_port(addr, result, ntohs(header->source_port));
651 if (rc != EOK) {
652 (void) dyn_fifo_pop(&socket->received);
653 return udp_release_and_return(packet, rc);
654 }
655 *addrlen = (size_t) result;
656
657 /* Send the source address */
658 rc = data_reply(addr, *addrlen);
659 switch (rc) {
660 case EOK:
661 break;
662 case EOVERFLOW:
663 return rc;
664 default:
665 (void) dyn_fifo_pop(&socket->received);
666 return udp_release_and_return(packet, rc);
667 }
668
669 /* Trim the header */
670 rc = packet_trim(packet, UDP_HEADER_SIZE, 0);
671 if (rc != EOK) {
672 (void) dyn_fifo_pop(&socket->received);
673 return udp_release_and_return(packet, rc);
674 }
675
676 /* Reply the packets */
677 rc = socket_reply_packets(packet, &length);
678 switch (rc) {
679 case EOK:
680 break;
681 case EOVERFLOW:
682 return rc;
683 default:
684 (void) dyn_fifo_pop(&socket->received);
685 return udp_release_and_return(packet, rc);
686 }
687
688 (void) dyn_fifo_pop(&socket->received);
689
690 /* Release the packet and return the total length */
691 return udp_release_and_return(packet, (int) length);
692}
693
694/** Processes the socket client messages.
695 *
696 * Runs until the client module disconnects.
697 *
698 * @param[in] callid The message identifier.
699 * @param[in] call The message parameters.
700 * @returns EOK on success.
701 *
702 * @see socket.h
703 */
704static int udp_process_client_messages(ipc_callid_t callid, ipc_call_t call)
705{
706 int res;
707 bool keep_on_going = true;
708 socket_cores_t local_sockets;
709 int app_phone = IPC_GET_PHONE(&call);
710 struct sockaddr *addr;
711 int socket_id;
712 size_t addrlen;
713 size_t size;
714 ipc_call_t answer;
715 int answer_count;
716 packet_dimension_t *packet_dimension;
717
718 /*
719 * Accept the connection
720 * - Answer the first IPC_M_CONNECT_TO_ME call.
721 */
722 res = EOK;
723 answer_count = 0;
724
725 /*
726 * The client connection is only in one fibril and therefore no
727 * additional locks are needed.
728 */
729
730 socket_cores_initialize(&local_sockets);
731
732 while (keep_on_going) {
733
734 /* Answer the call */
735 answer_call(callid, res, &answer, answer_count);
736
737 /* Refresh data */
738 refresh_answer(&answer, &answer_count);
739
740 /* Get the next call */
741 callid = async_get_call(&call);
742
743 /* Process the call */
744 switch (IPC_GET_METHOD(call)) {
745 case IPC_M_PHONE_HUNGUP:
746 keep_on_going = false;
747 res = EHANGUP;
748 break;
749
750 case NET_SOCKET:
751 socket_id = SOCKET_GET_SOCKET_ID(call);
752 res = socket_create(&local_sockets, app_phone, NULL,
753 &socket_id);
754 SOCKET_SET_SOCKET_ID(answer, socket_id);
755
756 if (res != EOK)
757 break;
758
759 if (tl_get_ip_packet_dimension(udp_globals.ip_phone,
760 &udp_globals.dimensions, DEVICE_INVALID_ID,
761 &packet_dimension) == EOK) {
762 SOCKET_SET_DATA_FRAGMENT_SIZE(answer,
763 packet_dimension->content);
764 }
765
766// SOCKET_SET_DATA_FRAGMENT_SIZE(answer,
767// MAX_UDP_FRAGMENT_SIZE);
768 SOCKET_SET_HEADER_SIZE(answer, UDP_HEADER_SIZE);
769 answer_count = 3;
770 break;
771
772 case NET_SOCKET_BIND:
773 res = data_receive((void **) &addr, &addrlen);
774 if (res != EOK)
775 break;
776 fibril_rwlock_write_lock(&udp_globals.lock);
777 res = socket_bind(&local_sockets, &udp_globals.sockets,
778 SOCKET_GET_SOCKET_ID(call), addr, addrlen,
779 UDP_FREE_PORTS_START, UDP_FREE_PORTS_END,
780 udp_globals.last_used_port);
781 fibril_rwlock_write_unlock(&udp_globals.lock);
782 free(addr);
783 break;
784
785 case NET_SOCKET_SENDTO:
786 res = data_receive((void **) &addr, &addrlen);
787 if (res != EOK)
788 break;
789
790 fibril_rwlock_write_lock(&udp_globals.lock);
791 res = udp_sendto_message(&local_sockets,
792 SOCKET_GET_SOCKET_ID(call), addr, addrlen,
793 SOCKET_GET_DATA_FRAGMENTS(call), &size,
794 SOCKET_GET_FLAGS(call));
795 SOCKET_SET_DATA_FRAGMENT_SIZE(answer, size);
796
797 if (res != EOK)
798 fibril_rwlock_write_unlock(&udp_globals.lock);
799 else
800 answer_count = 2;
801
802 free(addr);
803 break;
804
805 case NET_SOCKET_RECVFROM:
806 fibril_rwlock_write_lock(&udp_globals.lock);
807 res = udp_recvfrom_message(&local_sockets,
808 SOCKET_GET_SOCKET_ID(call), SOCKET_GET_FLAGS(call),
809 &addrlen);
810 fibril_rwlock_write_unlock(&udp_globals.lock);
811
812 if (res <= 0)
813 break;
814
815 SOCKET_SET_READ_DATA_LENGTH(answer, res);
816 SOCKET_SET_ADDRESS_LENGTH(answer, addrlen);
817 answer_count = 3;
818 res = EOK;
819 break;
820
821 case NET_SOCKET_CLOSE:
822 fibril_rwlock_write_lock(&udp_globals.lock);
823 res = socket_destroy(udp_globals.net_phone,
824 SOCKET_GET_SOCKET_ID(call), &local_sockets,
825 &udp_globals.sockets, NULL);
826 fibril_rwlock_write_unlock(&udp_globals.lock);
827 break;
828
829 case NET_SOCKET_GETSOCKOPT:
830 case NET_SOCKET_SETSOCKOPT:
831 default:
832 res = ENOTSUP;
833 break;
834 }
835 }
836
837 /* Release the application phone */
838 ipc_hangup(app_phone);
839
840 /* Release all local sockets */
841 socket_cores_release(udp_globals.net_phone, &local_sockets,
842 &udp_globals.sockets, NULL);
843
844 return res;
845}
846
847/** Processes the UDP message.
848 *
849 * @param[in] callid The message identifier.
850 * @param[in] call The message parameters.
851 * @param[out] answer The message answer parameters.
852 * @param[out] answer_count The last parameter for the actual answer in the
853 * answer parameter.
854 * @returns EOK on success.
855 * @returns ENOTSUP if the message is not known.
856 *
857 * @see udp_interface.h
858 * @see IS_NET_UDP_MESSAGE()
859 */
860int udp_message_standalone(ipc_callid_t callid, ipc_call_t *call,
861 ipc_call_t *answer, int *answer_count)
862{
863 packet_t packet;
864 int rc;
865
866 *answer_count = 0;
867
868 switch (IPC_GET_METHOD(*call)) {
869 case NET_TL_RECEIVED:
870 rc = packet_translate_remote(udp_globals.net_phone, &packet,
871 IPC_GET_PACKET(call));
872 if (rc != EOK)
873 return rc;
874 return udp_received_msg(IPC_GET_DEVICE(call), packet,
875 SERVICE_UDP, IPC_GET_ERROR(call));
876 case IPC_M_CONNECT_TO_ME:
877 return udp_process_client_messages(callid, * call);
878 }
879
880 return ENOTSUP;
881}
882
883/** Default thread for new connections.
884 *
885 * @param[in] iid The initial message identifier.
886 * @param[in] icall The initial message call structure.
887 */
888static void tl_client_connection(ipc_callid_t iid, ipc_call_t * icall)
889{
890 /*
891 * Accept the connection
892 * - Answer the first IPC_M_CONNECT_ME_TO call.
893 */
894 ipc_answer_0(iid, EOK);
895
896 while (true) {
897 ipc_call_t answer;
898 int answer_count;
899
900 /* Clear the answer structure */
901 refresh_answer(&answer, &answer_count);
902
903 /* Fetch the next message */
904 ipc_call_t call;
905 ipc_callid_t callid = async_get_call(&call);
906
907 /* Process the message */
908 int res = tl_module_message_standalone(callid, &call, &answer,
909 &answer_count);
910
911 /*
912 * End if told to either by the message or the processing
913 * result.
914 */
915 if ((IPC_GET_METHOD(call) == IPC_M_PHONE_HUNGUP) ||
916 (res == EHANGUP))
917 return;
918
919 /* Answer the message */
920 answer_call(callid, res, &answer, answer_count);
921 }
922}
923
924/** Starts the module.
925 *
926 * @returns EOK on success.
927 * @returns Other error codes as defined for each specific module
928 * start function.
929 */
930int main(int argc, char *argv[])
931{
932 int rc;
933
934 /* Start the module */
935 rc = tl_module_start_standalone(tl_client_connection);
936 return rc;
937}
938
939/** @}
940 */
Note: See TracBrowser for help on using the repository browser.