/*====================================================================* * * Copyright (c) 2013 Qualcomm Atheros, Inc. * * All rights reserved. * * Redistribution and use in source and binary forms, with or * without modification, are permitted (subject to the limitations * in the disclaimer below) provided that the following conditions * are met: * * * Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * * * Redistributions in binary form must reproduce the above * copyright notice, this list of conditions and the following * disclaimer in the documentation and/or other materials * provided with the distribution. * * * Neither the name of Qualcomm Atheros nor the names of * its contributors may be used to endorse or promote products * derived from this software without specific prior written * permission. * * NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE * GRANTED BY THIS LICENSE. THIS SOFTWARE IS PROVIDED BY THE * COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER * OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. * *--------------------------------------------------------------------*/ /*====================================================================* * * hpavd.c - Qualcomm Atheros Homeplug AV Packet Daemon; * * prints incoming Qualcomm Atheros HomePlug AV vendor-specific * management messages on stdout in hex dump format for analysis; * * the program can be run in foreground or background, as a daemon; * * this program receives raw ethernet frames and so requires root * privileges; if you install it using "chmod 555" and "chown * root:root" then you must login as root to run it; otherwise, you * can install it using "chmod 4555" and "chown root:root" so that * anyone can run it; the program will refuse to run until you get * thing right; * * * Contributor(s): * Charles Maier * *--------------------------------------------------------------------*/ /*====================================================================* * system header files; *--------------------------------------------------------------------*/ #include #include #include #include #include #include #include #include #include #include #ifdef __linux__ #include #include #include #include #endif /*====================================================================* * custom header files; *--------------------------------------------------------------------*/ #include "../tools/getoptv.h" #include "../tools/putoptv.h" #include "../tools/memory.h" #include "../tools/number.h" #include "../tools/types.h" #include "../tools/flags.h" #include "../tools/error.h" #include "../plc/plc.h" #include "../mme/mme.h" /*====================================================================* * custom source files; *--------------------------------------------------------------------*/ #ifndef MAKEFILE #include "../tools/getoptv.c" #include "../tools/putoptv.c" #include "../tools/version.c" #include "../tools/hexdump.c" #include "../tools/hexstring.c" #include "../tools/hexdecode.c" #include "../tools/error.c" #include "../tools/emalloc.c" #endif #ifndef MAKEFILE #include "../mme/MMEPeek.c" #include "../mme/MMEName.c" #include "../mme/MMEMode.c" #endif /*====================================================================* * program constants; *--------------------------------------------------------------------*/ #define HPAVD_DAEMON (1 << 0) #define HPAVD_VERBOSE (1 << 1) #define HPAVD_SILENCE (1 << 2) #define HPAVD_ERROR (1 << 3) #define PLCDEVICE "PLC" #define ETHDEVICE "eth1" #define ETHNUMBER 2 /*====================================================================* * program variables; *--------------------------------------------------------------------*/ static bool done = false; /*====================================================================* * * void terminate (signo_t signal); * * terminate the program; we want to ensure an orgaized program * exit so that the original Ethernet adapter state is restored; * * *--------------------------------------------------------------------*/ static void terminate (signo_t signal) { done = true; return; } /*====================================================================* * * int main (int argc, char * argv[]); * * *--------------------------------------------------------------------*/ int main (int argc, char const * argv []) { struct sigaction sa; struct ifreq ifreq; struct sockaddr_ll sockaddr = { PF_PACKET, htons (ETH_P_HPAV), 0x0000, ARPHRD_ETHER, PACKET_OTHERHOST, ETHER_ADDR_LEN, { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 } }; static char const * optv [] = { "di:qv", PUTOPTV_S_DIVINE, "Qualcomm Atheros HomePlug AV Packet Daemon", "d\trun in background as daemon", "i s\thost interface is (s) [" ETHDEVICE "]", "q\tsuppress normal output", "v\tverbose messages on stdout", (char const *) (0) }; uint8_t packet [ETHER_MAX_LEN]; flag_t state = (flag_t)(0); flag_t flags = (flag_t)(0); sock_t fd = -1; signed c; memset (&ifreq, 0, sizeof (ifreq)); memcpy (ifreq.ifr_name, ETHDEVICE, sizeof (ETHDEVICE)); if (getenv (PLCDEVICE)) { memcpy (ifreq.ifr_name, getenv (PLCDEVICE), sizeof (ifreq.ifr_name)); } optind = 1; while ((c = getoptv (argc, argv, optv)) != -1) { switch ((char) (c)) { case 'd': _setbits (flags, HPAVD_DAEMON); break; case 'i': memcpy (ifreq.ifr_name, optarg, sizeof (ifreq.ifr_name)); break; case 'q': _setbits (flags, HPAVD_SILENCE); break; case 'v': _setbits (flags, HPAVD_VERBOSE); break; default: break; } } argc -= optind; argv += optind; if (_anyset (flags, HPAVD_DAEMON)) { pid_t pid = fork (); if (pid < 0) { error (1, errno, "razzlefrats!"); } if (pid > 0) { exit (0); } } memset (&sa, 0, sizeof (struct sigaction)); sa.sa_handler = terminate; sigaction (SIGTERM, &sa, (struct sigaction *)(0)); sigaction (SIGQUIT, &sa, (struct sigaction *)(0)); sigaction (SIGTSTP, &sa, (struct sigaction *)(0)); sigaction (SIGINT, &sa, (struct sigaction *)(0)); sigaction (SIGHUP, &sa, (struct sigaction *)(0)); if ((fd = socket (sockaddr.sll_family, SOCK_RAW, sockaddr.sll_protocol)) == -1) { error (1, errno, "Can't create socket for %s", ifreq.ifr_name); } if (ioctl (fd, SIOCGIFFLAGS, &ifreq) < 0) { error (1, errno, "Can't read %s device state", ifreq.ifr_name); } state = ifreq.ifr_flags; _setbits (ifreq.ifr_flags, (IFF_UP | IFF_BROADCAST)); _clrbits (ifreq.ifr_flags, (IFF_MULTICAST | IFF_ALLMULTI | IFF_PROMISC)); if (ioctl (fd, SIOCSIFFLAGS, &ifreq) < 0) { error (1, errno, "Can't change %s device state", ifreq.ifr_name); } if (ioctl (fd, SIOCGIFINDEX, &ifreq) == -1) { error (1, errno, "Can't get %s interface index", ifreq.ifr_name); } sockaddr.sll_ifindex = ifreq.ifr_ifindex; if (ioctl (fd, SIOCGIFHWADDR, &ifreq) == -1) { error (1, errno, "Can't get %s hardware address", ifreq.ifr_name); } memcpy (sockaddr.sll_addr, ifreq.ifr_ifru.ifru_hwaddr.sa_data, sizeof (sockaddr.sll_addr)); if (bind (fd, (struct sockaddr *) (&sockaddr), sizeof (struct sockaddr_ll)) == -1) { error (1, errno, "Can't bind socket to %s", ifreq.ifr_name); } while (!done) { signed length = recvfrom (fd, packet, sizeof (packet), 0, (struct sockaddr *) (0), (socklen_t *)(0)); if (length > 0) { if (_allclr (flags, HPAVD_SILENCE)) { MMEPeek (&packet, length, stdout); } if (_anyset (flags, HPAVD_VERBOSE)) { hexdump (&packet, 0, length, stdout); } } } ifreq.ifr_flags = state; if (ioctl (fd, SIOCSIFFLAGS, &ifreq) < 0) { error (1, errno, "Can't restore %s device state", ifreq.ifr_name); } close (fd); return (0); }