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