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