parse_monitor.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 "parse_monitor.h"
  40
  41 struct monitor_reg_list xbee_monitor_list = LIST_HEAD_INITIALIZER();
  42
  43 static int8_t
  44 parse_monitor(PGM_P tk, const char *buf, void *res)
  45 {
  46         struct monitor_reg *m;
  47         uint8_t token_len = 0;
  48         char bufcopy[32];
  49
  50         (void)tk;
  51         while (!isendoftoken(buf[token_len]) &&
  52                token_len < (sizeof(bufcopy)-1)) {
  53                 bufcopy[token_len] = buf[token_len];
  54                 token_len++;
  55         }
  56         bufcopy[token_len] = 0;
  57
  58         LIST_FOREACH(m, &xbee_monitor_list, next) {
  59                 if (!strcmp_P(bufcopy, m->desc))
  60                         break;
  61         }
  62         if (m == NULL) /* not found */
  63                 return -1;
  64
  65         /* store the address of object in structure */
  66         if (res)
  67                 *(struct monitor_reg **)res = m;
  68
  69         return token_len;
  70 }
  71
  72 static int8_t
  73 complete_get_nb_monitor(PGM_P tk)
  74 {
  75         struct monitor_reg *m;
  76         int8_t i = 0;
  77
  78         (void)tk;
  79         LIST_FOREACH(m, &xbee_monitor_list, next) {
  80                 i++;
  81         }
  82         return i;
  83 }
  84
  85 static int8_t
  86 complete_get_elt_monitor(PGM_P tk, int8_t idx,
  87                           char *dstbuf, uint8_t size)
  88 {
  89         struct monitor_reg *m;
  90         int8_t i = 0, len;
  91
  92         (void)tk;
  93         LIST_FOREACH(m, &xbee_monitor_list, next) {
  94                 if (i == idx)
  95                         break;
  96                 i++;
  97         }
  98         if (m == NULL)
  99                 return -1;
 100
 101         len = snprintf_P(dstbuf, size, PSTR("%S"), m->desc);
 102         if (len < 0 || len >= size)
 103                 return -1;
 104
 105         return 0;
 106 }
 107
 108
 109 static int8_t
 110 help_monitor(PGM_P tk, char *dstbuf,
 111               uint8_t size)
 112 {
 113         (void)tk;
 114         snprintf_P(dstbuf, size, PSTR("Monitor-register"));
 115         return 0;
 116 }
 117
 118 struct token_ops token_monitor_ops = {
 119         .parse = parse_monitor,
 120         .complete_get_nb = complete_get_nb_monitor,
 121         .complete_get_elt = complete_get_elt_monitor,
 122         .get_help = help_monitor,
 123 };