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 #include "print.h"
  29
  30 void print_P(const char *s)
  31 {
  32         char c;
  33
  34         while (1) {
  35                 c = pgm_read_byte(s++);
  36                 if (!c) break;
  37                 if (c == '\n') usb_debug_putchar('\r');
  38                 usb_debug_putchar(c);
  39         }
  40 }
  41
  42 void phex1(unsigned char c)
  43 {
  44         usb_debug_putchar(c + ((c < 10) ? '0' : 'A' - 10));
  45 }
  46
  47 void phex(unsigned char c)
  48 {
  49         phex1(c >> 4);
  50         phex1(c & 15);
  51 }
  52
  53 void phex16(unsigned int i)
  54 {
  55         phex(i >> 8);
  56         phex(i);
  57 }
  58
  59
  60 void pbin(unsigned char c)
  61 {
  62     for (int i = 7; i >= 0; i--) {
  63         usb_debug_putchar((c & (1<<i)) ? '1' : '0');
  64     }
  65 }
  66
  67 void pbin_reverse(unsigned char c)
  68 {
  69     for (int i = 0; i < 8; i++) {
  70         usb_debug_putchar((c & (1<<i)) ? '1' : '0');
  71     }
  72 }