marc
/
RIOT
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Implement simple echo request/reply

Browse Source
dev/timer
authmillenon 10 years ago committed by authmillenon
parent 366d25ae38
commit 9117bb2b76
4 changed files with 166 additions and 0 deletions
Show Stats Download Patch File Download Diff File

14
sys/net/sixlowpan/sixlowip.c
Unescape Escape View File

@ -112,6 +112,20 @@ void sixlowpan_send(ipv6_addr_t *addr, uint8_t *payload, uint16_t p_len,
int icmpv6_demultiplex(const struct icmpv6_hdr_t *hdr)
{
switch(hdr->type) {
case (ICMP_ECHO_REQ): {
puts("INFO: packet type: icmp echo request");
/* processing echo request */
recv_echo_req();
break;
}
case (ICMP_ECHO_REPL): {
puts("INFO: packet type: icmp echo reply");
/* processing echo reply */
recv_echo_repl();
break;
}
case (ICMP_RTR_SOL): {
puts("INFO: packet type: icmp router solicitation");
/* processing router solicitation */

132
sys/net/sixlowpan/sixlownd.c
Unescape Escape View File

@ -97,6 +97,16 @@ static struct para_prob_t *get_para_prob_buf(uint8_t ext_len)
return ((struct para_prob_t *)&(buffer[LLHDR_ICMPV6HDR_LEN + ext_len]));
}
static struct echo_req_t *get_echo_req_buf(uint8_t ext_len)
{
return ((struct echo_req_t *)&(buffer[LLHDR_ICMPV6HDR_LEN + ext_len]));
}
static struct echo_repl_t *get_echo_repl_buf(uint8_t ext_len)
{
return ((struct echo_repl_t *)&(buffer[LLHDR_ICMPV6HDR_LEN + ext_len]));
}
static struct rtr_adv_t *get_rtr_adv_buf(uint8_t ext_len)
{
return ((struct rtr_adv_t *)&(buffer[LLHDR_ICMPV6HDR_LEN + ext_len]));
@ -159,6 +169,84 @@ static opt_aro_t *get_opt_aro_buf(uint8_t ext_len, uint8_t opt_len)
opt_len]));
}
void init_echo_req(ipv6_addr_t *destaddr, uint16_t id, uint16_t seq, char *data, size_t data_len)
{
ipv6_buf = get_ipv6_buf();
icmp_buf = get_icmpv6_buf(ipv6_ext_hdr_len);
struct echo_req_t *echo_buf = get_echo_req_buf(ipv6_ext_hdr_len);
char *echo_data_buf = ((char *)echo_buf)+sizeof (struct echo_req_t);
packet_length = 0;
icmp_buf->type = ICMP_ECHO_REQ;
icmp_buf->code = 0;
ipv6_buf->version_trafficclass = IPV6_VER;
ipv6_buf->trafficclass_flowlabel = 0;
ipv6_buf->flowlabel = 0;
ipv6_buf->nextheader = PROTO_NUM_ICMPV6;
ipv6_buf->hoplimit = 0xff;
memcpy(&ipv6_buf->destaddr, destaddr, sizeof (ipv6_addr_t));
ipv6_get_saddr(&ipv6_buf->srcaddr, &ipv6_buf->destaddr);
echo_buf->id = id;
echo_buf->seq = seq;
memcpy(echo_data_buf, data, data_len);
packet_length = IPV6_HDR_LEN + ICMPV6_HDR_LEN + ipv6_ext_hdr_len +
ECHO_REQ_LEN + data_len;
ipv6_buf->length = packet_length-IPV6_HDR_LEN;
icmp_buf->checksum = 0;
icmp_buf->checksum = ~icmpv6_csum(PROTO_NUM_ICMPV6);
#ifdef ENABLE_DEBUG
printf("INFO: send echo request to: ");
ipv6_print_addr(&ipv6_buf->destaddr);
#endif
lowpan_init((ieee_802154_long_t *)&(ipv6_buf->destaddr.uint16[4]),
(uint8_t *)ipv6_buf);
}
void init_echo_repl(ipv6_addr_t *destaddr, uint16_t id, uint16_t seq, char *data, size_t data_len)
{
ipv6_buf = get_ipv6_buf();
icmp_buf = get_icmpv6_buf(ipv6_ext_hdr_len);
struct echo_repl_t *echo_buf = get_echo_repl_buf(ipv6_ext_hdr_len);
char *echo_data_buf = ((char *)echo_buf)+sizeof (struct echo_repl_t);
packet_length = 0;
icmp_buf->type = ICMP_ECHO_REPL;
icmp_buf->code = 0;
ipv6_buf->version_trafficclass = IPV6_VER;
ipv6_buf->trafficclass_flowlabel = 0;
ipv6_buf->flowlabel = 0;
ipv6_buf->nextheader = PROTO_NUM_ICMPV6;
ipv6_buf->hoplimit = 0xff;
memcpy(&ipv6_buf->destaddr, destaddr, sizeof (ipv6_addr_t));
ipv6_get_saddr(&ipv6_buf->srcaddr, &ipv6_buf->destaddr);
echo_buf->id = id;
echo_buf->seq = seq;
memcpy(echo_data_buf, data, data_len);
packet_length = IPV6_HDR_LEN + ICMPV6_HDR_LEN + ipv6_ext_hdr_len +
ECHO_REPL_LEN + data_len;
ipv6_buf->length = packet_length-IPV6_HDR_LEN;
icmp_buf->checksum = 0;
icmp_buf->checksum = ~icmpv6_csum(PROTO_NUM_ICMPV6);
#ifdef ENABLE_DEBUG
printf("INFO: send echo request to: ");
ipv6_print_addr(&ipv6_buf->destaddr);
#endif
lowpan_init((ieee_802154_long_t *)&(ipv6_buf->destaddr.uint16[4]),
(uint8_t *)ipv6_buf);
}
/* send router solicitation message - RFC4861 section 4.1 */
void init_rtr_sol(uint8_t sllao)
{
@ -206,6 +294,50 @@ void init_rtr_sol(uint8_t sllao)
(uint8_t *)ipv6_buf);
}
void recv_echo_req(void)
{
ipv6_buf = get_ipv6_buf();
struct echo_req_t *echo_buf = get_echo_req_buf(ipv6_ext_hdr_len);
char *echo_data_buf = ((char *)echo_buf)+sizeof (struct echo_repl_t);
size_t data_len = ipv6_buf->length - (IPV6_HDR_LEN + ICMPV6_HDR_LEN +
ipv6_ext_hdr_len + ECHO_REQ_LEN);
#ifdef ENABLE_DEBUG
printf("INFO: received echo request from: ");
ipv6_print_addr(&ipv6_buf->srcaddr);
printf("\n");
printf("id = 0x%04x, seq = %d\n", echo_buf->id, echo_buf->seq);
for (int i = 0; i < data_len; i++) {
printf("%02x ", echo_data_buf[i]);
if ((i+1) % 16 || i == data_len-1) {
printf("\n");
}
}
#endif
init_echo_repl(&ipv6_buf->srcaddr, echo_buf->id, echo_buf->seq,
echo_data_buf, data_len);
}
void recv_echo_repl(void)
{
ipv6_buf = get_ipv6_buf();
struct echo_repl_t *echo_buf = get_echo_repl_buf(ipv6_ext_hdr_len);
char *echo_data_buf = ((char *)echo_buf)+sizeof (struct echo_repl_t);
size_t data_len = ipv6_buf->length - (IPV6_HDR_LEN + ICMPV6_HDR_LEN +
ipv6_ext_hdr_len + ECHO_REPL_LEN);
#ifdef ENABLE_DEBUG
printf("INFO: received echo reply from: ");
ipv6_print_addr(&ipv6_buf->srcaddr);
printf("\n");
printf("id = 0x%04x, seq = %d\n", echo_buf->id, echo_buf->seq);
for (int i = 0; i < data_len; i++) {
printf("%02x ", echo_data_buf[i]);
if ((i+1) % 16 || i == data_len-1) {
printf("\n");
}
}
#endif
}
void recv_rtr_sol(void)
{
opt_hdr_len = RTR_SOL_LEN;

18
sys/net/sixlowpan/sixlownd.h
Unescape Escape View File

@ -30,6 +30,10 @@
#define PARA_PROB_CODE_ERR (0) /* Erroneous header field encountered */
#define PARA_PROB_NXT_HDR_UNREC (1) /* Unrecognized Next Header type encountered */
#define PARA_PROB_IPV6_OPT_UNREC (2) /* Unrecognized IPv6 option encountered */
/* echo request */
#define ECHO_REQ_LEN (4)
/* echo reply */
#define ECHO_REPL_LEN (4)
/* router solicitation */
#define RTR_SOL_LEN (4)
#define RTR_SOL_INTERVAL (4)
@ -183,6 +187,16 @@ typedef struct __attribute__((packed)) {
uint8_t infinite;
} plist_t;
struct __attribute__((packed)) echo_req_t {
uint16_t id;
uint16_t seq;
};
struct __attribute__((packed)) echo_repl_t {
uint16_t id;
uint16_t seq;
};
struct __attribute__((packed)) rtr_adv_t {
uint8_t hoplimit;
uint8_t autoconfig_flags;
@ -235,6 +249,10 @@ void recv_rtr_sol(void);
void recv_rtr_adv(void);
void init_rtr_adv(ipv6_addr_t *addr, uint8_t sllao, uint8_t mtu, uint8_t pi,
uint8_t sixco, uint8_t abro);
void recv_echo_req(void);
void init_echo_req(ipv6_addr_t *destaddr, uint16_t id, uint16_t seq, char *data, size_t data_len);
void recv_echo_repl(void);
void init_echo_repl(ipv6_addr_t *destaddr, uint16_t id, uint16_t seq, char *data, size_t data_len);
uint8_t plist_search(ipv6_addr_t *addr);
uint8_t plist_cmp(ipv6_addr_t *addr1, ipv6_addr_t *addr2);
int8_t plist_add(ipv6_addr_t *addr, uint8_t size, uint32_t val_ltime,

2
sys/net/sixlowpan/sixlowpan.h
Unescape Escape View File

@ -47,6 +47,8 @@
/* icmp message types rfc4443 */
#define ICMP_PARA_PROB (4)
#define ICMP_ECHO_REQ (128)
#define ICMP_ECHO_REPL (129)
/* icmp message types rfc4861 4.*/
#define ICMP_RTR_ADV (134)
#define ICMP_RTR_SOL (133)

Write Preview
Loading…
Cancel
Save