gnrc_netif_hdr.c
2.12 KB
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
/*
* Copyright (C) 2015 Freie Universität Berlin
*
* This file is subject to the terms and conditions of the GNU Lesser
* General Public License v2.1. See the file LICENSE in the top level
* directory for more details.
*/
/**
* @{
*
* @file
* @author Martine Lenders <mlenders@inf.fu-berlin.de>
*/
#include "net/gnrc/netif/hdr.h"
gnrc_pktsnip_t *gnrc_netif_hdr_build(uint8_t *src, uint8_t src_len, uint8_t *dst, uint8_t dst_len)
{
gnrc_pktsnip_t *pkt = gnrc_pktbuf_add(NULL, NULL,
sizeof(gnrc_netif_hdr_t) + src_len + dst_len,
GNRC_NETTYPE_NETIF);
if (pkt == NULL) {
return NULL;
}
gnrc_netif_hdr_init(pkt->data, src_len, dst_len);
if (src != NULL && src_len > 0) {
gnrc_netif_hdr_set_src_addr(pkt->data, src, src_len);
}
if (dst != NULL && dst_len > 0) {
gnrc_netif_hdr_set_dst_addr(pkt->data, dst, dst_len);
}
return pkt;
}
uint8_t gnrc_netif_hdr_get_flag(gnrc_pktsnip_t* pkt)
{
assert(pkt != NULL);
pkt = gnrc_pktsnip_search_type(pkt, GNRC_NETTYPE_NETIF);
if (pkt && pkt->data) {
gnrc_netif_hdr_t *netif_hdr = pkt->data;
return netif_hdr->flags;
}
return 0U;
}
int gnrc_netif_hdr_get_dstaddr(gnrc_pktsnip_t* pkt, uint8_t** pointer_to_addr)
{
assert(pkt != NULL);
pkt = gnrc_pktsnip_search_type(pkt, GNRC_NETTYPE_NETIF);
if (pkt && pkt->data) {
gnrc_netif_hdr_t *netif_hdr = pkt->data;
if (netif_hdr->dst_l2addr_len > 0) {
*pointer_to_addr = gnrc_netif_hdr_get_dst_addr(netif_hdr);
return netif_hdr->dst_l2addr_len;
}
}
return -ENOENT;
}
int gnrc_netif_hdr_get_srcaddr(gnrc_pktsnip_t* pkt, uint8_t** pointer_to_addr)
{
assert(pkt != NULL);
pkt = gnrc_pktsnip_search_type(pkt, GNRC_NETTYPE_NETIF);
if (pkt && pkt->data) {
gnrc_netif_hdr_t *netif_hdr = pkt->data;
if (netif_hdr->src_l2addr_len > 0) {
*pointer_to_addr = gnrc_netif_hdr_get_src_addr(netif_hdr);
return netif_hdr->src_l2addr_len;
}
}
return -ENOENT;
}
/** @} */