xbee.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
  31
  32 #include <stdio.h>
  33 #include <stdint.h>
  34 #include <stdlib.h>
  35 #include <string.h>
  36 #include <errno.h>
  37
  38 #include "xbee_neighbor.h"
  39 #include "xbee_stats.h"
  40 #include "xbee_buf.h"
  41 #include "xbee_proto.h"
  42 #include "xbee.h"
  43
  44 int xbee_init(void)
  45 {
  46         return 0;
  47 }
  48
  49 int xbee_register_channel(struct xbee_dev *dev, int channel,
  50                           xbee_rx_cb_t *rx_cb, void *opaque)
  51 {
  52         /* user asked for any channel */
  53         if (channel == XBEE_CHANNEL_ANY) {
  54                 int ch;
  55
  56                 /* skip XBEE_DEFAULT_CHANNEL == 0 */
  57                 for (ch = 1; ch < XBEE_MAX_CHANNEL; ch++) {
  58                         if (dev->channel[ch].registered == 0) {
  59                                 channel = ch;
  60                                 break;
  61                         }
  62                 }
  63                 /* no available channels */
  64                 if (channel == XBEE_CHANNEL_ANY)
  65                         return -1;
  66         }
  67         /* user requested a specific channel */
  68         else if (channel < 0 || channel >= XBEE_MAX_CHANNEL ||
  69                  dev->channel[channel].registered == 1)
  70                 return -1; /* not available */
  71
  72         dev->channel[channel].registered = 1;
  73         dev->channel[channel].rx_cb = rx_cb;
  74         dev->channel[channel].arg = opaque;
  75         return channel;
  76 }
  77
  78 int xbee_unregister_channel(struct xbee_dev *dev, int channel)
  79 {
  80         if (channel < 0 || channel >= XBEE_MAX_CHANNEL ||
  81             dev->channel[channel].registered == 0)
  82                 return -1;
  83         dev->channel[channel].registered = 0;
  84         dev->channel[channel].rx_cb = NULL;
  85         dev->channel[channel].arg = NULL;
  86         return 0;
  87 }
  88
  89 int xbee_set_opaque(struct xbee_dev *dev, int channel, void *opaque)
  90 {
  91         if (channel < 0 || channel >= XBEE_MAX_CHANNEL ||
  92             dev->channel[channel].registered == 0)
  93                 return -1;
  94
  95         dev->channel[channel].arg = opaque;
  96         return 0;
  97 }
  98
  99 int xbee_open(struct xbee_dev *dev, FILE *xbee_file)
 100 {
 101         memset(dev, 0, sizeof(*dev));
 102         dev->file = xbee_file;
 103         xbee_neigh_init(dev);
 104         return 0;
 105 }