nuttx-apps/netutils/netlib/netlib.c

/****************************************************************************
 * netutils/netlib/netlib.c
 * Various uIP library functions.
 *
 *   Copyright (C) 2007, 2009, 2011 Gregory Nutt. All rights reserved.
 *   Author: Gregory Nutt <gnutt@nuttx.org>
 *
 * Based on uIP which also has a BSD style license:
 *
 *   Author: Adam Dunkels <adam@sics.se>
 *   Copyright (c) 2004, Adam Dunkels and the Swedish Institute of
 *   Computer Science.
 *   All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. The name of the author may not be used to endorse or promote
 *    products derived from this software without specific prior
 *    written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
 * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
 * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 ****************************************************************************/

/****************************************************************************
 * Included Files
 ****************************************************************************/

#include <stdint.h>
#include <stdbool.h>
#include <string.h>
#include <debug.h>

#include <apps/netutils/netlib.h>


/****************************************************************************
 * Public Functions
 ****************************************************************************/

bool netlib_ipaddrconv(const char *addrstr, uint8_t *ipaddr)
{
  unsigned char tmp;
  char c;
  unsigned char i;
  unsigned char j;

  tmp = 0;

  for (i = 0; i < 4; ++i)
    {
      j = 0;
      do
        {
          c = *addrstr;
          ++j;
          if (j > 4)
           {
             return false;
           }
          if (c == '.' || c == 0)
            {
              *ipaddr = tmp;
              ++ipaddr;
              tmp = 0;
            }
          else if (c >= '0' && c <= '9')
            {
              tmp = (tmp * 10) + (c - '0');
            }
          else
            {
              return false;
            }
          ++addrstr;
        }
      while (c != '.' && c != 0);
    }

  return true;
}

bool netlib_hwmacconv(const char *hwstr, uint8_t *hw)
{
  unsigned char tmp;
  char c;
  unsigned char i;
  unsigned char j;

  if (strlen(hwstr) != 17)
    {
      return false;
    }

  tmp = 0;

  for (i = 0; i < 6; ++i)
    {
      j = 0;
      do
        {
          c = *hwstr;
          ++j;
          if (j > 3)
           {
             return false;
           }

          if (c == ':' || c == 0)
            {
              *hw = tmp;
              nvdbg("HWMAC[%d]%0.2X\n",i,tmp);
              ++hw;
              tmp = 0;
            }
          else if (c >= '0' && c <= '9')
            {
              tmp = (tmp << 4) + (c - '0');
            }
          else if (c >= 'a' && c <= 'f')
            {
              tmp = (tmp << 4) + (c - 'a' + 10);
            }
          else if (c >= 'A' && c <= 'F')
            {
              tmp = (tmp << 4) + (c - 'A' + 10);
            }
          else
            {
              return false;
            }

          ++hwstr;
        }
      while (c != ':' && c != 0);
    }

  return true;
}