mirror of
https://github.com/RIOT-OS/RIOT.git
synced 2024-12-29 04:50:03 +01:00
138 lines
3.1 KiB
C
138 lines
3.1 KiB
C
/*
|
|
* Copyright (C) 2015-18 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.
|
|
*/
|
|
|
|
/**
|
|
* @defgroup app_sniffer
|
|
* @brief Sniffer application based on the new network stack
|
|
* @{
|
|
*
|
|
* @file
|
|
* @brief Sniffer application for RIOT
|
|
*
|
|
* @author Hauke Petersen <hauke.petersen@fu-berlin.de>
|
|
* @author Martine Lenders <m.lenders@fu-berlin.de>
|
|
*
|
|
* @}
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
|
|
#include "fmt.h"
|
|
#include "thread.h"
|
|
#include "shell.h"
|
|
#include "net/gnrc.h"
|
|
#include "ztimer64.h"
|
|
|
|
/**
|
|
* @brief Buffer size used by the shell
|
|
*/
|
|
#define SHELL_BUFSIZE (64U)
|
|
|
|
/**
|
|
* @brief Priority of the RAW dump thread
|
|
*/
|
|
#define RAWDUMP_PRIO (THREAD_PRIORITY_MAIN - 1)
|
|
|
|
/**
|
|
* @brief Message queue size of the RAW dump thread
|
|
*/
|
|
#define RAWDUMP_MSG_Q_SIZE (32U)
|
|
|
|
/**
|
|
* @brief Stack for the raw dump thread
|
|
*/
|
|
static char rawdmp_stack[THREAD_STACKSIZE_SMALL];
|
|
|
|
/**
|
|
* @brief Make a raw dump of the given packet contents
|
|
*/
|
|
void dump_pkt(gnrc_pktsnip_t *pkt)
|
|
{
|
|
gnrc_pktsnip_t *snip = pkt;
|
|
uint8_t lqi = 0;
|
|
if (pkt->next) {
|
|
if (pkt->next->type == GNRC_NETTYPE_NETIF) {
|
|
gnrc_netif_hdr_t *netif_hdr = pkt->next->data;
|
|
lqi = netif_hdr->lqi;
|
|
pkt = gnrc_pktbuf_remove_snip(pkt, pkt->next);
|
|
}
|
|
}
|
|
uint64_t now_us = ztimer64_now(ZTIMER64_USEC);
|
|
|
|
print_str("rftest-rx --- len ");
|
|
print_u32_hex((uint32_t)gnrc_pkt_len(pkt));
|
|
print_str(" lqi ");
|
|
print_byte_hex(lqi);
|
|
print_str(" rx_time ");
|
|
print_u64_hex(now_us);
|
|
print_str("\n");
|
|
while (snip) {
|
|
for (size_t i = 0; i < snip->size; i++) {
|
|
print_byte_hex(((uint8_t *)(snip->data))[i]);
|
|
print_str(" ");
|
|
}
|
|
snip = snip->next;
|
|
}
|
|
print_str("\n\n");
|
|
|
|
gnrc_pktbuf_release(pkt);
|
|
}
|
|
|
|
/**
|
|
* @brief Event loop of the RAW dump thread
|
|
*
|
|
* @param[in] arg unused parameter
|
|
*/
|
|
void *rawdump(void *arg)
|
|
{
|
|
msg_t msg_q[RAWDUMP_MSG_Q_SIZE];
|
|
|
|
(void)arg;
|
|
msg_init_queue(msg_q, RAWDUMP_MSG_Q_SIZE);
|
|
while (1) {
|
|
msg_t msg;
|
|
|
|
msg_receive(&msg);
|
|
switch (msg.type) {
|
|
case GNRC_NETAPI_MSG_TYPE_RCV:
|
|
dump_pkt((gnrc_pktsnip_t *)msg.content.ptr);
|
|
break;
|
|
default:
|
|
/* do nothing */
|
|
break;
|
|
}
|
|
}
|
|
|
|
/* never reached */
|
|
return NULL;
|
|
}
|
|
|
|
/**
|
|
* @brief Maybe you are a golfer?!
|
|
*/
|
|
int main(void)
|
|
{
|
|
gnrc_netreg_entry_t dump;
|
|
|
|
puts("RIOT sniffer application");
|
|
|
|
/* start and register rawdump thread */
|
|
puts("Run the rawdump thread and register it");
|
|
dump.target.pid = thread_create(rawdmp_stack, sizeof(rawdmp_stack), RAWDUMP_PRIO,
|
|
0, rawdump, NULL, "rawdump");
|
|
dump.demux_ctx = GNRC_NETREG_DEMUX_CTX_ALL;
|
|
gnrc_netreg_register(GNRC_NETTYPE_UNDEF, &dump);
|
|
|
|
/* start the shell */
|
|
puts("All ok, starting the shell now");
|
|
char line_buf[SHELL_DEFAULT_BUFSIZE];
|
|
shell_run(NULL, line_buf, SHELL_DEFAULT_BUFSIZE);
|
|
|
|
return 0;
|
|
}
|