Mercurial > louis > kiibohd-controller

annotate Bootloader/debug.c @ 412:e7a3be42ae1e

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
Debug code for interconnect cable debugging
author Jacob Alexander <haata@kiibohd.com>
date Sat, 20 Feb 2016 13:27:49 -0800
parents 2f415c0b4b28
children
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
339
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
1 /* Copyright (C) 2015 by Jacob Alexander
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
2 *
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
3 * Permission is hereby granted, free of charge, to any person obtaining a copy
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
4 * of this software and associated documentation files (the "Software"), to deal
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
5 * in the Software without restriction, including without limitation the rights
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
6 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
7 * copies of the Software, and to permit persons to whom the Software is
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
8 * furnished to do so, subject to the following conditions:
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
9 *
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
10 * The above copyright notice and this permission notice shall be included in
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
11 * all copies or substantial portions of the Software.
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
12 *
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
13 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
14 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
15 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
16 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
17 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
18 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
19 * THE SOFTWARE.
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
20 */
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
21
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
22 // ----- Includes -----
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
23
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
24 // Local Includes
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
25 #include "mchck.h"
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
26
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
27
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
28
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
29 // ----- Defines -----
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
30
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
31 // UART Configuration
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
32 #if defined(_mk20dx256vlh7_) // UART2 Debug
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
33 #define UART_BDH UART2_BDH
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
34 #define UART_BDL UART2_BDL
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
35 #define UART_C1 UART2_C1
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
36 #define UART_C2 UART2_C2
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
37 #define UART_C3 UART2_C3
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
38 #define UART_C4 UART2_C4
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
39 #define UART_CFIFO UART2_CFIFO
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
40 #define UART_D UART2_D
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
41 #define UART_PFIFO UART2_PFIFO
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
42 #define UART_RCFIFO UART2_RCFIFO
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
43 #define UART_RWFIFO UART2_RWFIFO
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
44 #define UART_S1 UART2_S1
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
45 #define UART_S2 UART2_S2
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
46 #define UART_SFIFO UART2_SFIFO
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
47 #define UART_TWFIFO UART2_TWFIFO
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
48
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
49 #define SIM_SCGC4_UART SIM_SCGC4_UART2
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
50 #define IRQ_UART_STATUS IRQ_UART2_STATUS
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
51
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
52 #else
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
53 #error "Bootloader UART Debug unsupported"
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
54 #endif
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
55
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
56
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
57
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
58 // ----- Functions -----
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
59
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
60 #if defined(_mk20dx256vlh7_)
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
61
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
62 void uart_serial_setup()
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
63 {
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
64 // Setup the the UART interface for keyboard data input
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
65 SIM_SCGC4 |= SIM_SCGC4_UART; // Disable clock gating
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
66
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
67 // Kiibohd-dfu
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
68 #if defined(_mk20dx256vlh7_)
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
69 // Pin Setup for UART2
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
70 PORTD_PCR3 = PORT_PCR_DSE | PORT_PCR_SRE | PORT_PCR_MUX(3); // TX Pin
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
71 #endif
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
72
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
73
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
74 #if defined(_mk20dx256vlh7_) // UART2 Debug
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
75 // Setup baud rate - 115200 Baud
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
76 // Uses Bus Clock
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
77 // 36 MHz / ( 16 * Baud ) = BDH/L
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
78 // Baud: 115200 -> 36 MHz / ( 16 * 115200 ) = 19.53125
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
79 // Thus baud setting = 19
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
80 // NOTE: If finer baud adjustment is needed see UARTx_C4 -> BRFA in the datasheet
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
81 uint16_t baud = 19; // Max setting of 8191
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
82 UART_BDH = (uint8_t)(baud >> 8);
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
83 UART_BDL = (uint8_t)baud;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
84 UART_C4 = 0x11;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
85
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
86 #endif
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
87
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
88 // 8 bit, No Parity, Idle Character bit after stop
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
89 UART_C1 = UART_C1_ILT;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
90
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
91 // TX FIFO Enabled, TX FIFO Size 1 (Max 8 datawords)
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
92 // TX/RX FIFO Size:
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
93 // 0x0 - 1 dataword
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
94 // 0x1 - 4 dataword
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
95 // 0x2 - 8 dataword
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
96 UART_PFIFO = UART_PFIFO_TXFE;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
97
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
98 // TX Enabled, RX Enabled, RX Interrupt Enabled, Generate idles
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
99 // UART_C2_TE UART_C2_RE UART_C2_RIE UART_C2_ILIE
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
100 UART_C2 = UART_C2_TE | UART_C2_ILIE;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
101 }
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
102
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
103
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
104 int uart_serial_write( const void *buffer, uint32_t size )
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
105 {
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
106 const uint8_t *data = (const uint8_t *)buffer;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
107 uint32_t position = 0;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
108
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
109 // While buffer is not empty and transmit buffer is
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
110 while ( position < size )
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
111 {
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
112 while ( !( UART_SFIFO & UART_SFIFO_TXEMPT ) ); // Wait till there is room to send
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
113 UART_D = data[position++];
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
114 }
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
115
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
116 return 0;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
117 }
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
118
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
119
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
120 int Output_putstr( char* str )
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
121 {
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
122 uint32_t count = 0;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
123
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
124 // Count characters until NULL character, then send the amount counted
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
125 while ( str[count] != '\0' )
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
126 count++;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
127
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
128 return uart_serial_write( str, count );
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
129 }
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
130
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
131
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
132 uint16_t lenStr( char* in )
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
133 {
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
134 // Iterator
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
135 char *pos;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
136
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
137 // Loop until null is found
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
138 for ( pos = in; *pos; pos++ );
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
139
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
140 // Return the difference between the pointers of in and pos (which is the string length)
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
141 return (pos - in);
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
142 }
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
143
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
144
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
145 void revsStr( char* in )
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
146 {
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
147 // Iterators
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
148 int i, j;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
149
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
150 // Temp storage
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
151 char c;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
152
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
153 // Loop through the string, and reverse the order of the characters
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
154 for ( i = 0, j = lenStr( in ) - 1; i < j; i++, j-- )
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
155 {
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
156 c = in[i];
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
157 in[i] = in[j];
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
158 in[j] = c;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
159 }
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
160 }
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
161
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
162
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
163 void hexToStr_op( uint32_t in, char* out, uint8_t op )
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
164 {
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
165 // Position container
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
166 uint32_t pos = 0;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
167
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
168 // Evaluate through digits as hex
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
169 do
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
170 {
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
171 uint32_t cur = in % 16;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
172 out[pos++] = cur + (( cur < 10 ) ? '0' : 'A' - 10);
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
173 }
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
174 while ( (in /= 16) > 0 );
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
175
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
176 // Output formatting options
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
177 switch ( op )
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
178 {
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
179 case 1: // Add 0x
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
180 out[pos++] = 'x';
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
181 out[pos++] = '0';
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
182 break;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
183 case 2: // 8-bit padding
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
184 case 4: // 16-bit padding
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
185 case 8: // 32-bit padding
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
186 while ( pos < op )
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
187 out[pos++] = '0';
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
188 break;
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
189 }
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
190
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
191 // Append null
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
192 out[pos] = '\0';
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
193
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
194 // Reverse the string to the correct order
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
195 revsStr( out );
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
196 }
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
197
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
198
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
199 void printHex_op( uint32_t in, uint8_t op )
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
200 {
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
201 // With an op of 1, the max number of characters is 6 + 1 for null
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
202 // e.g. "0xFFFF\0"
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
203 // op 2 and 4 require fewer characters (2+1 and 4+1 respectively)
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
204 char tmpStr[7];
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
205
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
206 // Convert number
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
207 hexToStr_op( in, tmpStr, op );
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
208
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
209 // Print number
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
210 Output_putstr( tmpStr );
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
211 }
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
212
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
213 #endif
2f415c0b4b28 Adding missing debug header.
Jacob Alexander <haata@kiibohd.com>
parents:
diff changeset
214