123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596 |
- /* Copyright (C) 2015-2016 Andrew J. Kroll
- and
- Copyright (C) 2011 Circuits At Home, LTD. All rights reserved.
-
- This program is free software; you can redistribute it and/or modify
- it under the terms of the GNU General Public License as published by
- the Free Software Foundation; either version 2 of the License, or
- (at your option) any later version.
-
- This program is distributed in the hope that it will be useful,
- but WITHOUT ANY WARRANTY; without even the implied warranty of
- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- GNU General Public License for more details.
-
- You should have received a copy of the GNU General Public License
- along with this program; if not, write to the Free Software
- Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-
- Contact information
- -------------------
-
- Circuits At Home, LTD
- Web : https://www.circuitsathome.com
- e-mail : support@circuitsathome.com
- */
-
- #if !defined(_UHS_host_h_) || defined(__PRINTHEX_H__)
- #error "Never include UHS_printhex.h directly; include UHS_Usb.h instead"
- #else
- #define __PRINTHEX_H__
-
- void E_Notifyc(char c, int lvl);
-
- template <class T>
- void PrintHex(T val, int lvl) {
- int num_nybbles = sizeof (T) * 2;
-
- do {
- char v = 48 + (((val >> (num_nybbles - 1) * 4)) & 0x0F);
- if(v > 57) v += 7;
- E_Notifyc(v, lvl);
- } while(--num_nybbles);
- }
-
- template <class T>
- void PrintBin(T val, int lvl) {
- for(T mask = (((T)1) << ((sizeof (T) << 3) - 1)); mask; mask >>= 1)
- if(val & mask)
- E_Notifyc('1', lvl);
- else
- E_Notifyc('0', lvl);
- }
-
- template <class T>
- void SerialPrintHex(T val) {
- int num_nybbles = sizeof (T) * 2;
-
- do {
- char v = 48 + (((val >> (num_nybbles - 1) * 4)) & 0x0F);
- if(v > 57) v += 7;
- USB_HOST_SERIAL.print(v);
- } while(--num_nybbles);
- }
-
- template <class T>
- void PrintHex2(Print *prn, T val) {
- T mask = (((T)1) << (((sizeof (T) << 1) - 1) << 2));
-
- while(mask > 1) {
- if(val < mask)
- prn->print("0");
-
- mask >>= 4;
- }
- prn->print((T)val, HEX);
- }
-
- #ifdef DEBUG_USB_HOST
- template <class T> void D_PrintHex(T val, int lvl) {
- PrintHex<T > (val, lvl);
- #else
- template <class T> void D_PrintHex(NOTUSED(T val), NOTUSED(int lvl)) {
- #endif
- }
-
- #ifdef DEBUG_USB_HOST
- template <class T> void D_PrintBin(T val, int lvl) {
- PrintBin<T > (val, lvl);
- #else
- template <class T> void D_PrintBin(NOTUSED(T val), NOTUSED(int lvl)) {
- #endif
- }
-
-
-
- #endif // __PRINTHEX_H__
|