parse_neighbor.c

   1 /*
   2  * Copyright (c) 2011, Olivier MATZ <zer0@droids-corp.org>
   3  * All rights reserved.
   4  * Redistribution and use in source and binary forms, with or without
   5  * modification, are permitted provided that the following conditions are met:
   6  *
   7  *     * Redistributions of source code must retain the above copyright
   8  *       notice, this list of conditions and the following disclaimer.
   9  *     * Redistributions in binary form must reproduce the above copyright
  10  *       notice, this list of conditions and the following disclaimer in the
  11  *       documentation and/or other materials provided with the distribution.
  12  *     * Neither the name of the University of California, Berkeley nor the
  13  *       names of its contributors may be used to endorse or promote products
  14  *       derived from this software without specific prior written permission.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND ANY
  17  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
  18  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
  19  * DISCLAIMED. IN NO EVENT SHALL THE REGENTS AND CONTRIBUTORS BE LIABLE FOR ANY
  20  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  21  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  22  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
  23  * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  24  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  25  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  26  */
  27
  28 #include <aversive.h>
  29 #include <aversive/queue.h>
  30 #include <aversive/pgmspace.h>
  31
  32 #include <stdio.h>
  33 #include <inttypes.h>
  34 #include <ctype.h>
  35 #include <string.h>
  36
  37 #include <parse.h>
  38
  39 #include "xbee_neighbor.h"
  40 #include "xbee_atcmd.h"
  41 #include "xbee_stats.h"
  42 #include "xbee_buf.h"
  43 #include "xbee_proto.h"
  44 #include "xbee.h"
  45
  46 #include "parse_neighbor.h"
  47
  48 static int8_t
  49 parse_neighbor(PGM_P tk, const char *buf, void *res)
  50 {
  51         struct token_neighbor_data tkd;
  52         struct xbee_dev *dev;
  53         struct xbee_neigh *neigh;
  54         uint8_t token_len = 0;
  55         char bufcopy[32];
  56
  57         memcpy_P(&tkd, &((struct token_neighbor *)tk)->neighbor_data,
  58                  sizeof(tkd));
  59         dev = *tkd.xbee_dev;
  60
  61         while (!isendoftoken(buf[token_len]) &&
  62                token_len < (sizeof(bufcopy)-1)) {
  63                 bufcopy[token_len] = buf[token_len];
  64                 token_len++;
  65         }
  66         bufcopy[token_len] = 0;
  67         neigh = xbee_neigh_lookup(dev, bufcopy);
  68         if (neigh == NULL) /* not found */
  69                 return -1;
  70
  71         /* store the address of xbee_neigh in structure */
  72         if (res)
  73                 *(struct xbee_neigh **)res = neigh;
  74
  75         return token_len;
  76 }
  77
  78 static int8_t
  79 complete_get_nb_neighbor(PGM_P tk)
  80 {
  81         struct token_neighbor_data tkd;
  82         struct xbee_dev *dev;
  83         struct xbee_neigh *neigh;
  84         int8_t i = 0;
  85
  86         memcpy_P(&tkd, &((struct token_neighbor *)tk)->neighbor_data,
  87                  sizeof(tkd));
  88         dev = *tkd.xbee_dev;
  89
  90         LIST_FOREACH(neigh, &dev->neigh_list, next) {
  91                 i++;
  92         }
  93         return i;
  94 }
  95
  96 static int8_t
  97 complete_get_elt_neighbor(PGM_P tk, int8_t idx,
  98                           char *dstbuf, uint8_t size)
  99 {
 100         struct token_neighbor_data tkd;
 101         struct xbee_dev *dev;
 102         struct xbee_neigh *neigh;
 103         int8_t i = 0, len;
 104
 105         memcpy_P(&tkd, &((struct token_neighbor *)tk)->neighbor_data,
 106                  sizeof(tkd));
 107         dev = *tkd.xbee_dev;
 108
 109         LIST_FOREACH(neigh, &dev->neigh_list, next) {
 110                 if (i++ == idx)
 111                         break;
 112         }
 113
 114         if (neigh == NULL)
 115                 return -1;
 116
 117         len = snprintf_P(dstbuf, size, PSTR("%s"), neigh->name);
 118         if (len < 0 || len >= size)
 119                 return -1;
 120
 121         return 0;
 122 }
 123
 124
 125 static int8_t
 126 help_neighbor(PGM_P tk, char *dstbuf, uint8_t size)
 127 {
 128         (void)tk;
 129         snprintf_P(dstbuf, size, PSTR("Neighbor"));
 130         return 0;
 131 }
 132
 133 struct token_ops token_neighbor_ops = {
 134         .parse = parse_neighbor,
 135         .complete_get_nb = complete_get_nb_neighbor,
 136         .complete_get_elt = complete_get_elt_neighbor,
 137         .get_help = help_neighbor,
 138 };