/**************************************************************************** * apps/wireless/ieee802154/i8sak/i8sak_blaster.c * IEEE 802.15.4 Swiss Army Knife * * Copyright (C) 2014-2015, 2017 Gregory Nutt. All rights reserved. * Copyright (C) 2014-2015 Sebastien Lorquet. All rights reserved. * Copyright (C) 2017 Verge Inc. All rights reserved. * * Author: Sebastien Lorquet * Author: Anthony Merlino * Author: Gregory Nuttx * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. 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. * 3. Neither the name NuttX nor the names of its contributors may be * used to endorse or promote products derived from this software * without specific prior written permission. * * 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. * ****************************************************************************/ /**************************************************************************** * Included Files ****************************************************************************/ #include #include #include #include #include #include #include #include #include #include #include #include "wireless/ieee802154.h" #include "i8sak.h" /**************************************************************************** * Private Function Prototypes ****************************************************************************/ static inline void i8sak_blaster_start(FAR struct i8sak_s *i8sak); /**************************************************************************** * Private Functions ****************************************************************************/ static inline void i8sak_blaster_start(FAR struct i8sak_s *i8sak) { if (!i8sak->blasterenabled) { i8sak->startblaster = true; /* Signal the daemon to start running */ printf("i8sak: starting blaster\n"); sem_post(&i8sak->updatesem); } } /**************************************************************************** * Public Functions ****************************************************************************/ /**************************************************************************** * Name : i8sak_blaster * * Description : * Continuously transmit a packet ****************************************************************************/ void i8sak_blaster_cmd(FAR struct i8sak_s *i8sak, int argc, FAR char *argv[]) { int option; if (argc < 2) { i8sak_blaster_start(i8sak); } while ((option = getopt(argc, argv, "hqp:f:")) != ERROR) { switch (option) { case 'h': fprintf(stderr, "Blasts frames\n" "Usage: %s [-h|q|f |p ]\n" " -h = this help menu\n" " -q = quit blasting\n" " -f = set frame (and starts blaster)\n" " -p = set period (and start blaster)\n" "Note: No option starts blaster with defaults\n" , argv[0]); /* Must manually reset optind if we are going to exit early */ optind = -1; return; case 'q': /* Quit blaster */ i8sak->blasterenabled = false; break; case 'p': /* Inline change blaster period */ i8sak->blasterperiod = atoi(optarg); i8sak_blaster_start(i8sak); break; case 'f': /* Inline change blaster frame */ i8sak->payload_len = i8sak_str2payload(optarg, &i8sak->payload[0]); i8sak_blaster_start(i8sak); break; case ':': fprintf(stderr, "ERROR: missing argument\n"); /* Must manually reset optind if we are going to exit early */ optind = -1; i8sak_cmd_error(i8sak); /* This exits for us */ break; case '?': fprintf(stderr, "ERROR: unknown argument\n"); /* Must manually reset optind if we are going to exit early */ optind = -1; i8sak_cmd_error(i8sak); /* This exits for us */ } } } /**************************************************************************** * Name : i8sak_blaster_thread * * Description : * Send frames periodically ****************************************************************************/ pthread_addr_t i8sak_blaster_thread(pthread_addr_t arg) { FAR struct i8sak_s *i8sak = (FAR struct i8sak_s *)arg; struct mac802154dev_txframe_s tx; #ifdef CONFIG_NET_6LOWPAN if (i8sak->mode == I8SAK_MODE_NETIF) { if (bind(i8sak->fd, (struct sockaddr*)&i8sak->ep_in6addr, sizeof(struct sockaddr_in6)) < 0) { fprintf(stderr, "ERROR: failure to bind sock: %d\n", errno); exit(1); } } #endif while (i8sak->blasterenabled) { usleep(i8sak->blasterperiod*1000); if (i8sak->mode == I8SAK_MODE_CHAR) { /* Set an application defined handle */ tx.meta.handle = i8sak->msdu_handle++; /* This is a normal transaction, no special handling */ tx.meta.flags.ackreq = 1; tx.meta.flags.usegts = 0; tx.meta.ranging = IEEE802154_NON_RANGING; tx.meta.srcmode = i8sak->addrmode; memcpy(&tx.meta.destaddr, &i8sak->ep_addr, sizeof(struct ieee802154_addr_s)); /* Each byte is represented by 2 chars */ tx.length = i8sak->payload_len; tx.payload = &i8sak->payload[0]; write(i8sak->fd, &tx, sizeof(struct mac802154dev_txframe_s)); } #ifdef CONFIG_NET_6LOWPAN else if (i8sak->mode == I8SAK_MODE_NETIF) { sendto(i8sak->fd, i8sak->payload, i8sak->payload_len, 0, (struct sockaddr*)&i8sak->ep_in6addr, sizeof(struct sockaddr_in6)); } #endif } return NULL; }