3939#include < malloc.h>
4040#include < Arduino.h>
4141#include < ctype.h>
42+ #include < common_func.h>
4243
4344// defined in linker script
4445extern uint32_t __data_start__[];
@@ -106,14 +107,14 @@ static void printMemRegion(const char* name, uint32_t top, uint32_t bottom, uint
106107 sprintf (buffer, " %lu" , top-bottom);
107108 }
108109
109- printf (" | %-5s| 0x%04X - 0x%04X | %-19s |\n " , name, (uint16_t ) bottom, (uint16_t ) (top-1 ), buffer);
110+ PRINTF (" | %-5s| 0x%04X - 0x%04X | %-19s |\n " , name, (uint16_t ) bottom, (uint16_t ) (top-1 ), buffer);
110111}
111112
112113void dbgMemInfo (void )
113114{
114- printf (" ______________________________________________\n " );
115- printf (" | Name | Addr 0x2000xxxx | Usage |\n " );
116- printf (" | ---------------------------------------------|\n " );
115+ PRINTF (" ______________________________________________\n " );
116+ PRINTF (" | Name | Addr 0x2000xxxx | Usage |\n " );
117+ PRINTF (" | ---------------------------------------------|\n " );
117118
118119 // Pritn SRAM used for Stack executed by Softdevice and ISR
119120 printMemRegion (" Stack" , ((uint32_t ) __StackTop), ((uint32_t ) __StackLimit), dbgStackUsed () );
@@ -127,29 +128,29 @@ void dbgMemInfo(void)
127128 // Print SRAM Used by SoftDevice
128129 printMemRegion (" SD" , (uint32_t ) __data_start__, 0x20000000 , 0 );
129130
130- printf (" |______________________________________________|\n " );
131- printf (" \n " );
131+ PRINTF (" |______________________________________________|\n " );
132+ PRINTF (" \n " );
132133
133134 // Print Task list
134135 uint32_t tasknum = uxTaskGetNumberOfTasks ();
135136 char * buf = (char *) rtos_malloc (tasknum*40 ); // 40 bytes per task
136137
137138 vTaskList (buf);
138139
139- printf (" Task State Prio StackLeft Num\n " );
140- printf (" -----------------------------------\n " );
141- printf (buf);
142- printf (" \n " );
140+ PRINTF (" Task State Prio StackLeft Num\n " );
141+ PRINTF (" -----------------------------------\n " );
142+ PRINTF (buf);
143+ PRINTF (" \n " );
143144 rtos_free (buf);
144145}
145146
146147void dbgPrintVersion (void )
147148{
148- printf (" \n " );
149- printf (" BSP Library : " ARDUINO_BSP_VERSION " \n " );
150- printf (" Bootloader : %s\n " , getBootloaderVersion ());
151- printf (" Serial No : %s\n " , getMcuUniqueID ());
152- printf (" \n " );
149+ PRINTF (" \n " );
150+ PRINTF (" BSP Library : " ARDUINO_BSP_VERSION " \n " );
151+ PRINTF (" Bootloader : %s\n " , getBootloaderVersion ());
152+ PRINTF (" Serial No : %s\n " , getMcuUniqueID ());
153+ PRINTF (" \n " );
153154}
154155
155156/* *****************************************************************************/
@@ -163,15 +164,15 @@ static void dump_str_line(uint8_t const* buf, uint16_t count)
163164 for (int i=0 ; i<count; i++)
164165 {
165166 const char ch = buf[i];
166- printf (" %c" , isprint (ch) ? ch : ' .' );
167+ PRINTF (" %c" , isprint (ch) ? ch : ' .' );
167168 }
168169}
169170
170171void dbgDumpMemory (void const *buf, uint8_t size, uint16_t count, bool printOffset)
171172{
172173 if ( !buf || !count )
173174 {
174- printf (" NULL\n " );
175+ PRINTF (" NULL\n " );
175176 return ;
176177 }
177178
@@ -191,26 +192,26 @@ void dbgDumpMemory(void const *buf, uint8_t size, uint16_t count, bool printOffs
191192 // Print Ascii
192193 if ( i != 0 )
193194 {
194- printf (" | " );
195+ PRINTF (" | " );
195196 dump_str_line (buf8-16 , 16 );
196- printf (" \n " );
197+ PRINTF (" \n " );
197198 }
198199
199200 // print offset or absolute address
200201 if (printOffset)
201202 {
202- printf (" %03lX: " , 16 *i/item_per_line);
203+ PRINTF (" %03lX: " , 16 *i/item_per_line);
203204 }else
204205 {
205- printf (" %08lX:" , (uint32_t ) buf8);
206+ PRINTF (" %08lX:" , (uint32_t ) buf8);
206207 }
207208 }
208209
209210 memcpy (&value, buf8, size);
210211 buf8 += size;
211212
212- printf (" " );
213- printf (format, value);
213+ PRINTF (" " );
214+ PRINTF (format, value);
214215 }
215216
216217 // fill up last row to 16 for printing ascii
@@ -221,46 +222,46 @@ void dbgDumpMemory(void const *buf, uint8_t size, uint16_t count, bool printOffs
221222 {
222223 for (int i=0 ; i< 16 -remain; i++)
223224 {
224- printf (" " );
225- for (int j=0 ; j<2 *size; j++) printf (" " );
225+ PRINTF (" " );
226+ for (int j=0 ; j<2 *size; j++) PRINTF (" " );
226227 }
227228 }
228229
229- printf (" | " );
230+ PRINTF (" | " );
230231 dump_str_line (buf8-nback, nback);
231- printf (" \n " );
232+ PRINTF (" \n " );
232233
233- printf (" \n " );
234+ PRINTF (" \n " );
234235}
235236
236237
237238void dbgDumpMemoryCFormat (const char * str, void const *buf, uint16_t count)
238239{
239240 if ( !buf )
240241 {
241- printf (" NULL\n " );
242+ PRINTF (" NULL\n " );
242243 return ;
243244 }
244245
245- printf (" %s = \n {\n " , str);
246+ PRINTF (" %s = \n {\n " , str);
246247
247248 uint8_t const *buf8 = (uint8_t const *) buf;
248249
249250 for (uint32_t i=0 ; i<count; i++)
250251 {
251252 if ( i%16 == 0 )
252253 {
253- if ( i != 0 ) printf (" ,\n " );
254+ if ( i != 0 ) PRINTF (" ,\n " );
254255 }else
255256 {
256- if ( i != 0 ) printf (" , " );
257+ if ( i != 0 ) PRINTF (" , " );
257258 }
258259
259- printf (" 0x%02X" , *buf8);
260+ PRINTF (" 0x%02X" , *buf8);
260261 buf8++;
261262 }
262263
263- printf (" \n };\n " );
264+ PRINTF (" \n };\n " );
264265}
265266
266267
0 commit comments