1 /* Copyright (C) 2011-2014 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
22 // ----- Includes -----
32 // ----- Functions -----
34 // Multiple string Output
35 void printstrs( char* first, ... )
37 // Initialize the variadic function parameter list
40 // Get the first parameter
41 va_start( ap, first );
44 // Loop through the variadic list until "\0\0\0" is found
45 while ( !( cur[0] == '\0' && cur[1] == '\0' && cur[2] == '\0' ) )
47 // Print out the given string
50 // Get the next argument ready
51 cur = va_arg( ap, char* );
54 va_end( ap ); // Not required, but good practice
57 // Print a constant string
58 void _print( const char* s )
60 #if defined(_at90usb162_) || defined(_atmega32u4_) || defined(_at90usb646_) || defined(_at90usb1286_) // AVR
61 // Pull string out of flash
63 while ( ( c = pgm_read_byte( s++ ) ) != '\0' )
67 #elif defined(_mk20dx128_) || defined(_mk20dx128vlf5_) || defined(_mk20dx256_) // ARM
68 Output_putstr( (char*)s );
74 // Number Printing Functions
75 void printInt8( uint8_t in )
77 // Max number of characters is 3 + 1 for null
81 int8ToStr( in, tmpStr );
87 void printInt16( uint16_t in )
89 // Max number of characters is 5 + 1 for null
93 int16ToStr( in, tmpStr );
99 void printInt32( uint32_t in )
101 // Max number of characters is 10 + 1 for null
105 int32ToStr( in, tmpStr );
111 void printHex_op( uint16_t in, uint8_t op )
113 // With an op of 1, the max number of characters is 6 + 1 for null
115 // op 2 and 4 require fewer characters (2+1 and 4+1 respectively)
119 hexToStr_op( in, tmpStr, op );
125 void printHex32_op( uint32_t in, uint8_t op )
127 // With an op of 1, the max number of characters is 6 + 1 for null
129 // op 2 and 4 require fewer characters (2+1 and 4+1 respectively)
133 hex32ToStr_op( in, tmpStr, op );
142 void int8ToStr( uint8_t in, char* out )
144 // Position and sign containers
148 // Evaluate through digits as decimal
151 out[pos++] = in % 10 + '0';
153 while ( (in /= 10) > 0 );
158 // Reverse the string to the correct order
163 void int16ToStr( uint16_t in, char* out )
165 // Position and sign containers
169 // Evaluate through digits as decimal
172 out[pos++] = in % 10 + '0';
174 while ( (in /= 10) > 0 );
179 // Reverse the string to the correct order
184 void int32ToStr( uint32_t in, char* out )
186 // Position and sign containers
190 // Evaluate through digits as decimal
193 out[pos++] = in % 10 + '0';
195 while ( (in /= 10) > 0 );
200 // Reverse the string to the correct order
205 void hexToStr_op( uint16_t in, char* out, uint8_t op )
207 // Position container
210 // Evaluate through digits as hex
213 uint16_t cur = in % 16;
214 out[pos++] = cur + (( cur < 10 ) ? '0' : 'A' - 10);
216 while ( (in /= 16) > 0 );
218 // Output formatting options
225 case 2: // 8-bit padding
226 case 4: // 16-bit padding
235 // Reverse the string to the correct order
240 void hex32ToStr_op( uint32_t in, char* out, uint8_t op )
242 // Position container
245 // Evaluate through digits as hex
248 uint32_t cur = in % 16;
249 out[pos++] = cur + (( cur < 10 ) ? '0' : 'A' - 10);
251 while ( (in /= 16) > 0 );
253 // Output formatting options
260 case 2: // 8-bit padding
261 case 4: // 16-bit padding
270 // Reverse the string to the correct order
275 void revsStr( char* in )
283 // Loop through the string, and reverse the order of the characters
284 for ( i = 0, j = lenStr( in ) - 1; i < j; i++, j-- )
293 uint16_t lenStr( char* in )
298 // Loop until null is found
299 for ( pos = in; *pos; pos++ );
301 // Return the difference between the pointers of in and pos (which is the string length)
306 int16_t eqStr( char* str1, char* str2 )
308 // Scan each string for NULLs and whether they are the same
309 while( *str1 != '\0' && *str1++ == *str2++ );
311 // If the strings are still identical (i.e. both NULL), then return -1, otherwise current *str1
312 // If *str1 is 0, then str1 ended (and str1 is "like" str2), otherwise strings are different
313 return *--str1 == *--str2 ? -1 : *++str1;
316 int numToInt( char* in )
318 // Pointers to the LSD (Least Significant Digit) and MSD
323 int sign = 1; // Default to positive
324 uint8_t base = 10; // Use base 10 by default TODO Add support for bases other than 10 and 16
326 // Scan the string once to determine the length
327 while ( *lsd != '\0' )
329 // Check for positive/negative
332 // Fall through is intentional, only do something on negative, ignore the rest
333 // Update the MSD to remove leading spaces and signs
339 case 'x': // Hex Mode
346 // Process string depending on which base
350 // Rescan the string from the LSD to MSD to convert it to a decimal number
351 for ( unsigned int digit = 1; lsd > msd ; digit *= 10 )
352 total += ( (*--lsd) - '0' ) * digit;
356 // Rescan the string from the LSD to MSD to convert it to a hexadecimal number
357 for ( unsigned int digit = 1; lsd > msd ; digit *= 0x10 )
359 if ( *--lsd <= '9' ) total += ( *lsd - '0' ) * digit;
360 else if ( *lsd <= 'F' ) total += ( *lsd - 'A' + 10 ) * digit;
361 else if ( *lsd <= 'f' ) total += ( *lsd - 'a' + 10 ) * digit;
366 // Propagate sign and return