teensy3/nonstd.c

   1 /* Teensyduino Core Library
   2  * http://www.pjrc.com/teensy/
   3  * Copyright (c) 2013 PJRC.COM, LLC.
   4  *
   5  * Permission is hereby granted, free of charge, to any person obtaining
   6  * a copy of this software and associated documentation files (the
   7  * "Software"), to deal in the Software without restriction, including
   8  * without limitation the rights to use, copy, modify, merge, publish,
   9  * distribute, sublicense, and/or sell copies of the Software, and to
  10  * permit persons to whom the Software is furnished to do so, subject to
  11  * the following conditions:
  12  *
  13  * 1. The above copyright notice and this permission notice shall be
  14  * included in all copies or substantial portions of the Software.
  15  *
  16  * 2. If the Software is incorporated into a build system that allows
  17  * selection among a list of target devices, then similar target
  18  * devices manufactured by PJRC.COM must be included in the list of
  19  * target devices and selectable in the same manner.
  20  *
  21  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  22  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  23  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  24  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  25  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  26  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  27  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  28  * SOFTWARE.
  29  */
  30
  31 #include "avr_functions.h"
  32 #include <string.h>
  33 #include <stdio.h>
  34
  35 size_t strlen(const char *s)
  36 {
  37         size_t n=0;
  38
  39         while (*s++) n++;
  40         return n;
  41 }
  42
  43
  44 char * ultoa(unsigned long val, char *buf, int radix)
  45 {
  46         unsigned digit;
  47         int i=0, j;
  48         char t;
  49
  50         while (1) {
  51                 digit = val % radix;
  52                 buf[i] = ((digit < 10) ? '0' + digit : 'A' + digit - 10);
  53                 val /= radix;
  54                 if (val == 0) break;
  55                 i++;
  56         }
  57         buf[i + 1] = 0;
  58         for (j=0; j < i; j++, i--) {
  59                 t = buf[j];
  60                 buf[j] = buf[i];
  61                 buf[i] = t;
  62         }
  63         return buf;
  64 }
  65
  66 char * ltoa(long val, char *buf, int radix)
  67 {
  68         if (val >= 0) {
  69                 return ultoa(val, buf, radix);
  70         } else {
  71                 buf[0] = '-';
  72                 ultoa(-val, buf + 1, radix);
  73                 return buf;
  74         }
  75 }
  76
  77 // TODO: actually write an efficient dtostrf()....
  78 char * dtostrf(float val, int width, unsigned int precision, char *buf)
  79 {
  80         char format[20];
  81         sprintf(format, "%%%d.%df", width, precision);
  82         sprintf(buf, format, val);
  83         return buf;
  84 }
  85