1 /* Copyright (C) 2011 by Jacob Alexander
3 * Permission is hereby granted, free of charge, to any person obtaining a copy
4 * of this software and associated documentation files (the "Software"), to deal
5 * in the Software without restriction, including without limitation the rights
6 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
7 * copies of the Software, and to permit persons to whom the Software is
8 * furnished to do so, subject to the following conditions:
10 * The above copyright notice and this permission notice shall be included in
11 * all copies or substantial portions of the Software.
13 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
14 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
15 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
16 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
17 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
18 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
27 #include <avr/pgmspace.h>
35 // USB HID String Output
36 void usb_debug_putstr( char* s )
39 usb_debug_putchar( *s++ );
42 // Multiple string Output
43 void usb_debug_putstrs( char* first, ... )
45 // Initialize the variadic function parameter list
48 // Get the first parameter
49 va_start( ap, first );
52 // Loop through the variadic list until "\0\0\0" is found
53 while ( !( cur[0] == '\0' && cur[1] == '\0' && cur[2] == '\0' ) )
55 // Print out the given string
56 usb_debug_putstr( cur );
58 // Get the next argument ready
59 cur = va_arg( ap, char* );
62 va_end( ap ); // Not required, but good practice
65 // Print a constant string
66 void _print(const char *s)
70 // Acquire the character from flash, and print it, as long as it's not NULL
71 // Also, if a newline is found, print a carrige return as well
72 while ( ( c = pgm_read_byte(s++) ) != '\0' )
75 usb_debug_putchar('\r');
84 void int8ToStr( uint8_t in, char* out )
86 // Position and sign containers
90 // Evaluate through digits as decimal
93 out[pos++] = in % 10 + '0';
95 while ( (in /= 10) > 0 );
100 // Reverse the string to the correct order
105 void int16ToStr( uint16_t in, char* out )
107 // Position and sign containers
111 // Evaluate through digits as decimal
114 out[pos++] = in % 10 + '0';
116 while ( (in /= 10) > 0 );
121 // Reverse the string to the correct order
126 void hexToStr_op( uint16_t in, char* out, uint8_t op )
128 // Position container
131 // Evaluate through digits as hex
134 uint16_t cur = in % 16;
135 out[pos++] = cur + (( cur < 10 ) ? '0' : 'A' - 10);
137 while ( (in /= 16) > 0 );
139 // Output formatting options
146 case 2: // 8-bit padding
147 case 4: // 16-bit padding
156 // Reverse the string to the correct order
161 void revsStr( char* in )
169 // Loop through the string, and reverse the order of the characters
170 for ( i = 0, j = lenStr( in ) - 1; i < j; i++, j-- )
179 uint16_t lenStr( char* in )
184 // Loop until null is found
185 for ( pos = in; *pos; pos++ );
187 // Return the difference between the pointers of in and pos (which is the string length)