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