From patchwork Mon Nov 21 20:34:17 2016 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Stefan Schmidt X-Patchwork-Id: 9440023 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 64A6A60469 for ; Mon, 21 Nov 2016 20:34:42 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 57B3528891 for ; Mon, 21 Nov 2016 20:34:42 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 4BFCE28897; Mon, 21 Nov 2016 20:34:42 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-6.9 required=2.0 tests=BAYES_00,RCVD_IN_DNSWL_HI autolearn=ham version=3.3.1 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id D801028891 for ; Mon, 21 Nov 2016 20:34:41 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1754854AbcKUUel (ORCPT ); Mon, 21 Nov 2016 15:34:41 -0500 Received: from proxima.lasnet.de ([78.47.171.185]:47100 "EHLO proxima.lasnet.de" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1754751AbcKUUel (ORCPT ); Mon, 21 Nov 2016 15:34:41 -0500 Received: from localhost.localdomain (p20030048092FF37D9A8389FFFE20FF3F.dip0.t-ipconnect.de [IPv6:2003:48:92f:f37d:9a83:89ff:fe20:ff3f]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) (Authenticated sender: stefan@sostec.de) by proxima.lasnet.de (Postfix) with ESMTPSA id 64060C5318; Mon, 21 Nov 2016 21:34:39 +0100 (CET) From: Stefan Schmidt To: linux-wpan@vger.kernel.org Cc: Alexander Aring , Stefan Schmidt Subject: [PATCH wpan-tools 4/8] examples: add af_packet_rx example Date: Mon, 21 Nov 2016 21:34:17 +0100 Message-Id: <1479760461-18947-5-git-send-email-stefan@osg.samsung.com> X-Mailer: git-send-email 2.5.5 In-Reply-To: <1479760461-18947-1-git-send-email-stefan@osg.samsung.com> References: <1479760461-18947-1-git-send-email-stefan@osg.samsung.com> Sender: linux-wpan-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-wpan@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP Special use case to get the whole 802.15.4 frame over the socket. Interesting for network monitoring, packet generation and network stacks in userspace. Signed-off-by: Stefan Schmidt --- examples/Makefile.am | 3 +- examples/af_packet_rx.c | 95 +++++++++++++++++++++++++++++++++++++++++++++++++ 2 files changed, 97 insertions(+), 1 deletion(-) create mode 100644 examples/af_packet_rx.c diff --git a/examples/Makefile.am b/examples/Makefile.am index 1ebedf9..2d188a7 100644 --- a/examples/Makefile.am +++ b/examples/Makefile.am @@ -1,4 +1,5 @@ bin_PROGRAMS = af_ieee802154_tx \ - af_ieee802154_rx + af_ieee802154_rx \ + af_packet_rx EXTRA_DIST = README.examples diff --git a/examples/af_packet_rx.c b/examples/af_packet_rx.c new file mode 100644 index 0000000..9770965 --- /dev/null +++ b/examples/af_packet_rx.c @@ -0,0 +1,95 @@ +/* + * IEEE 802.15.4 socket example + * + * Copyright (C) 2016 Samsung Electronics Co., Ltd. + * + * Author: Stefan Schmidt + * + * Permission to use, copy, modify, and/or distribute this software for any + * purpose with or without fee is hereby granted, provided that the above + * copyright notice and this permission notice appear in all copies. + * + * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES + * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF + * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR + * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES + * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN + * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF + * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. + */ + +/* gcc af_packet_rx.c -o af_packet_rx */ + +#include +#include +#include +#include +#include + +#include +#include + +#include +#include + +#define IEEE802154_ADDR_LEN 8 +#define MAX_PACKET_LEN 127 + +#ifndef ETH_P_IEEE802154 +#define ETH_P_IEEE802154 0x00F6 +#endif + +int main(int argc, char *argv[]) { + int ret, sd, i; + ssize_t len; + unsigned char buf[MAX_PACKET_LEN + 1]; + struct sockaddr_ll sll; + struct ifreq ifr; + + /* Create AF_PACKET address family socket for the SOCK_RAW type */ + sd = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_IEEE802154)); + if (sd < 0) { + perror("socket"); + return 1; + } + + /* Get interface index */ + strncpy(ifr.ifr_name, "monitor0", IFNAMSIZ); + ret = ioctl(sd, SIOCGIFINDEX, &ifr); + if (ret < 0) { + perror("ioctl"); + close(sd); + return 1; + } + + /* Prepare source socket address struct */ + memset(&sll, 0, sizeof(sll)); + sll.sll_family = AF_PACKET; + sll.sll_ifindex = ifr.ifr_ifindex; + sll.sll_protocol = htons(ETH_P_IEEE802154); + + /* Bind socket on this side */ + ret = bind(sd, (struct sockaddr *)&sll, sizeof(sll)); + if (ret < 0) { + perror("bind"); + close(sd); + return 1; + } + + while (1) { + /* Receive and print the whole packet payload, including FCS */ + len = recv(sd, buf, MAX_PACKET_LEN, 0); + if (len < 0) { + perror("recv"); + continue; + } + printf("Received:"); + for (i = 0; i < len; i++) + printf(" %x", buf[i]); + printf("\n"); + } + + shutdown(sd, SHUT_RDWR); + close(sd); + return 0; +}