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 #include <xbee.h>
  39
  40 #include "parse_neighbor.h"
  41
  42 static int8_t
  43 parse_neighbor(PGM_P tk, const char *buf, void *res)
  44 {
  45         struct token_neighbor_data tkd;
  46         struct xbee_dev *dev;
  47         struct xbee_neigh *neigh;
  48         uint8_t token_len = 0;
  49         char bufcopy[32];
  50
  51         memcpy_P(&tkd, &((struct token_neighbor *)tk)->neighbor_data,
  52                  sizeof(tkd));
  53         dev = *tkd.xbee_dev;
  54
  55         while (!isendoftoken(buf[token_len]) &&
  56                token_len < (sizeof(bufcopy)-1)) {
  57                 bufcopy[token_len] = buf[token_len];
  58                 token_len++;
  59         }
  60         bufcopy[token_len] = 0;
  61         neigh = xbee_neigh_lookup(dev, bufcopy);
  62         if (neigh == NULL) /* not found */
  63                 return -1;
  64
  65         /* store the address of xbee_neigh in structure */
  66         if (res)
  67                 *(struct xbee_neigh **)res = neigh;
  68
  69         return token_len;
  70 }
  71
  72 static int8_t
  73 complete_get_nb_neighbor(PGM_P tk)
  74 {
  75         struct token_neighbor_data tkd;
  76         struct xbee_dev *dev;
  77         struct xbee_neigh *neigh;
  78         int8_t i = 0;
  79
  80         memcpy_P(&tkd, &((struct token_neighbor *)tk)->neighbor_data,
  81                  sizeof(tkd));
  82         dev = *tkd.xbee_dev;
  83
  84         LIST_FOREACH(neigh, &dev->neigh_list, next) {
  85                 i++;
  86         }
  87         return i;
  88 }
  89
  90 static int8_t
  91 complete_get_elt_neighbor(PGM_P tk, int8_t idx,
  92                           char *dstbuf, uint8_t size)
  93 {
  94         struct token_neighbor_data tkd;
  95         struct xbee_dev *dev;
  96         struct xbee_neigh *neigh;
  97         int8_t i = 0, len;
  98
  99         memcpy_P(&tkd, &((struct token_neighbor *)tk)->neighbor_data,
 100                  sizeof(tkd));
 101         dev = *tkd.xbee_dev;
 102
 103         LIST_FOREACH(neigh, &dev->neigh_list, next) {
 104                 if (i++ == idx)
 105                         break;
 106         }
 107
 108         if (neigh == NULL)
 109                 return -1;
 110
 111         len = snprintf_P(dstbuf, size, PSTR("%s"), neigh->name);
 112         if (len < 0 || len >= size)
 113                 return -1;
 114
 115         return 0;
 116 }
 117
 118
 119 static int8_t
 120 help_neighbor(PGM_P tk, char *dstbuf, uint8_t size)
 121 {
 122         (void)tk;
 123         snprintf_P(dstbuf, size, PSTR("Neighbor"));
 124         return 0;
 125 }
 126
 127 struct token_ops token_neighbor_ops = {
 128         .parse = parse_neighbor,
 129         .complete_get_nb = complete_get_nb_neighbor,
 130         .complete_get_elt = complete_get_elt_neighbor,
 131         .get_help = help_neighbor,
 132 };