mirror of
https://github.com/RIOT-OS/RIOT.git
synced 2024-12-29 04:50:03 +01:00
4068133f3d
All other layers in the network stack use a msg_queue to not drop messages, which in this context represent packages. This finally fixes the random crashes when UDP network traffic is present. Turns out RIOT is not handling lost messages well.
83 lines
2.1 KiB
C
83 lines
2.1 KiB
C
/**
|
|
* Destiny UDP implementation
|
|
*
|
|
* Copyright (C) 2013 INRIA.
|
|
*
|
|
* This file is subject to the terms and conditions of the GNU Lesser General
|
|
* Public License. See the file LICENSE in the top level directory for more
|
|
* details.
|
|
*
|
|
* @ingroup destiny
|
|
* @{
|
|
* @file udp.c
|
|
* @brief UDP implementation
|
|
* @author Oliver Gesch <oliver.gesch@googlemail.com>
|
|
* @}
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
|
|
#include "ipv6.h"
|
|
#include "msg.h"
|
|
#include "sixlowpan.h"
|
|
#include "thread.h"
|
|
|
|
#include "destiny/in.h"
|
|
|
|
#include "net_help.h"
|
|
|
|
#include "msg_help.h"
|
|
#include "socket.h"
|
|
|
|
#include "udp.h"
|
|
|
|
msg_t udp_msg_queue[UDP_PKT_RECV_BUF_SIZE];
|
|
|
|
uint16_t udp_csum(ipv6_hdr_t *ipv6_header, udp_hdr_t *udp_header)
|
|
{
|
|
uint16_t sum;
|
|
uint16_t len = NTOHS(udp_header->length);
|
|
|
|
sum = len + IPPROTO_UDP;
|
|
sum = csum(sum, (uint8_t *)&ipv6_header->srcaddr, 2 * sizeof(ipv6_addr_t));
|
|
sum = csum(sum, (uint8_t *)udp_header, len);
|
|
return (sum == 0) ? 0xffff : HTONS(sum);
|
|
}
|
|
|
|
void udp_packet_handler(void)
|
|
{
|
|
msg_t m_recv_ip, m_send_ip, m_recv_udp, m_send_udp;
|
|
ipv6_hdr_t *ipv6_header;
|
|
udp_hdr_t *udp_header;
|
|
socket_internal_t *udp_socket = NULL;
|
|
uint16_t chksum;
|
|
|
|
msg_init_queue(udp_msg_queue, UDP_PKT_RECV_BUF_SIZE);
|
|
|
|
while (1) {
|
|
msg_receive(&m_recv_ip);
|
|
ipv6_header = ((ipv6_hdr_t *)m_recv_ip.content.ptr);
|
|
udp_header = ((udp_hdr_t *)(m_recv_ip.content.ptr + IPV6_HDR_LEN));
|
|
|
|
chksum = ipv6_csum(ipv6_header, (uint8_t*) udp_header, NTOHS(udp_header->length), IPPROTO_UDP);
|
|
|
|
if (chksum == 0xffff) {
|
|
udp_socket = get_udp_socket(udp_header);
|
|
|
|
if (udp_socket != NULL) {
|
|
m_send_udp.content.ptr = (char *)ipv6_header;
|
|
msg_send_receive(&m_send_udp, &m_recv_udp, udp_socket->recv_pid);
|
|
}
|
|
else {
|
|
printf("Dropped UDP Message because no thread ID was found for delivery!\n");
|
|
}
|
|
}
|
|
else {
|
|
printf("Wrong checksum (%x)!\n", chksum);
|
|
}
|
|
|
|
msg_reply(&m_recv_ip, &m_send_ip);
|
|
}
|
|
}
|