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