print.c

   1 /* Very basic print functions, intended to be used with usb_debug_only.c
   2  * http://www.pjrc.com/teensy/
   3  * Copyright (c) 2008 PJRC.COM, LLC
   4  *
   5  * Permission is hereby granted, free of charge, to any person obtaining a copy
   6  * of this software and associated documentation files (the "Software"), to deal
   7  * in the Software without restriction, including without limitation the rights
   8  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
   9  * copies of the Software, and to permit persons to whom the Software is
  10  * furnished to do so, subject to the following conditions:
  11  *
  12  * The above copyright notice and this permission notice shall be included in
  13  * all copies or substantial portions of the Software.
  14  *
  15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  17  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  18  * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  19  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  20  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  21  * THE SOFTWARE.
  22  */
  23
  24 // Version 1.0: Initial Release
  25
  26 #include <avr/io.h>
  27 #include <avr/pgmspace.h>
  28
  29 #include "print.h"
  30
  31 void print_P(const char *s)
  32 {
  33         char c;
  34
  35         while (1) {
  36                 c = pgm_read_byte(s++);
  37                 if (!c) break;
  38                 if (c == '\n') usb_debug_putchar('\r');
  39                 usb_debug_putchar(c);
  40         }
  41 }
  42
  43 void phex1(unsigned char c)
  44 {
  45         usb_debug_putchar(c + ((c < 10) ? '0' : 'A' - 10));
  46 }
  47
  48 void phex(unsigned char c)
  49 {
  50         phex1(c >> 4);
  51         phex1(c & 15);
  52 }
  53
  54 void phex16(unsigned int i)
  55 {
  56         phex(i >> 8);
  57         phex(i);
  58 }
  59
  60
  61
  62