123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384 |
- /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved.
-
- This software may be distributed and modified under the terms of the GNU
- General Public License version 2 (GPL2) as published by the Free Software
- Foundation and appearing in the file GPL2.TXT included in the packaging of
- this file. Please note that GPL2 Section 2[b] requires that all works based
- on this software must also be made publicly available under the terms of
- the GPL2 ("Copyleft").
-
- Contact information
- -------------------
-
- Circuits At Home, LTD
- Web : http://www.circuitsathome.com
- e-mail : [email protected]
- */
-
- #if !defined(_usb_h_) || defined(__PRINTHEX_H__)
- #error "Never include printhex.h directly; include 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_nibbles = sizeof (T) * 2;
-
- do {
- char v = 48 + (((val >> (num_nibbles - 1) * 4)) & 0x0f);
- if(v > 57) v += 7;
- E_Notifyc(v, lvl);
- } while(--num_nibbles);
- }
-
- 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_nibbles = sizeof (T) * 2;
-
- do {
- char v = 48 + (((val >> (num_nibbles - 1) * 4)) & 0x0f);
- if(v > 57) v += 7;
- USB_HOST_SERIAL.print(v);
- } while(--num_nibbles);
- }
-
- 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);
- }
-
- template <class T> void D_PrintHex(T val, int lvl) {
- #ifdef DEBUG_USB_HOST
- PrintHex<T > (val, lvl);
- #endif
- }
-
- template <class T>
- void D_PrintBin(T val, int lvl) {
- #ifdef DEBUG_USB_HOST
- PrintBin<T > (val, lvl);
- #endif
- }
-
-
-
- #endif // __PRINTHEX_H__
|