]> git.sur5r.net Git - freertos/blob - FreeRTOS/Demo/RX600_RX630-RSK_Renesas/RTOSDemo/main-full.c
f8322eadaad15ed86f8f1fff94fb6bc507f28724
[freertos] / FreeRTOS / Demo / RX600_RX630-RSK_Renesas / RTOSDemo / main-full.c
1 /*\r
2  * FreeRTOS Kernel V10.2.1\r
3  * Copyright (C) 2019 Amazon.com, Inc. or its affiliates.  All Rights Reserved.\r
4  *\r
5  * Permission is hereby granted, free of charge, to any person obtaining a copy of\r
6  * this software and associated documentation files (the "Software"), to deal in\r
7  * the Software without restriction, including without limitation the rights to\r
8  * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of\r
9  * the Software, and to permit persons to whom the Software is furnished to do so,\r
10  * subject to the following conditions:\r
11  *\r
12  * The above copyright notice and this permission notice shall be included in all\r
13  * copies or substantial portions of the Software.\r
14  *\r
15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR\r
16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS\r
17  * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR\r
18  * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER\r
19  * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN\r
20  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.\r
21  *\r
22  * http://www.FreeRTOS.org\r
23  * http://aws.amazon.com/freertos\r
24  *\r
25  * 1 tab == 4 spaces!\r
26  */\r
27 \r
28 /* ****************************************************************************\r
29  * This project includes a lot of tasks and tests and is therefore complex.\r
30  * If you would prefer a much simpler project to get started with then select\r
31  * the 'Blinky' build configuration within the HEW IDE.  The Blinky build\r
32  * configuration uses main-blinky.c instead of main-full.c.\r
33  * ****************************************************************************\r
34  *\r
35  * Creates all the demo application tasks, then starts the scheduler.  The web\r
36  * documentation provides more details of the standard demo application tasks,\r
37  * which provide no particular functionality but do provide a good example of\r
38  * how to use the FreeRTOS API.  The tasks defined in flop.c are included in the\r
39  * set of standard demo tasks to ensure the floating point unit gets some\r
40  * exercise.\r
41  *\r
42  * In addition to the standard demo tasks, the following tasks and tests are\r
43  * defined and/or created within this file:\r
44  *\r
45  * "Reg test" tasks - These fill the registers with known values, then \r
46  * repeatedly check that each register still contains its expected value for \r
47  * the lifetime of the tasks.  Each task uses different values.  The tasks run \r
48  * with very low priority so get preempted very frequently.  A check variable \r
49  * is incremented on each iteration of the test loop.  A register containing an \r
50  * unexpected value is indicative of an error in the context switching \r
51  * mechanism and will result in a branch to a null loop - which in turn will \r
52  * prevent the check variable from incrementing any further and allow the check \r
53  * timer (described below) to determine that an error has occurred.  The nature \r
54  * of the reg test tasks necessitates that they are written in assembly code.\r
55  *\r
56  * "Check Timer" and Callback Function - The check timer period is initially \r
57  * set to five seconds.  The check timer callback function checks that all the \r
58  * standard demo tasks are not only still executing, but are executing without \r
59  * reporting any errors.  If the check timer discovers that a task has either \r
60  * stalled, or reported an error, then it changes its own period from the \r
61  * initial five seconds, to just 200ms.  The check timer callback function \r
62  * also toggles LED 3 each time it is called.  This provides a visual \r
63  * indication of the system status:  If the LED toggles every five seconds, \r
64  * then no issues have been discovered.  If the LED toggles every 200ms, then \r
65  * an issue has been discovered with at least one task.\r
66  *\r
67  * "High frequency timer test" - A high frequency periodic interrupt is\r
68  * generated using a timer - the interrupt is assigned a priority above\r
69  * configMAX_SYSCALL_INTERRUPT_PRIORITY, so will not be effected by anything\r
70  * the kernel is doing.  The frequency and priority of the interrupt, in\r
71  * combination with other standard tests executed in this demo, will result\r
72  * in interrupts nesting at least 3 and probably 4 deep.  This test is only\r
73  * included in build configurations that have the optimiser switched on.\r
74  *\r
75  * *NOTE 1* If LED3 is toggling every 5 seconds then all the demo application\r
76  * tasks are executing as expected and no errors have been reported in any\r
77  * tasks.  The toggle rate increasing to 200ms indicates that at least one task\r
78  * has reported unexpected behaviour.\r
79  *\r
80  * *NOTE 2* vApplicationSetupTimerInterrupt() is called by the kernel to let\r
81  * the application set up a timer to generate the tick interrupt.  In this\r
82  * example a compare match timer is used for this purpose.\r
83  *\r
84  * *NOTE 3* The CPU must be in Supervisor mode when the scheduler is started.\r
85  * The PowerON_Reset_PC() supplied in resetprg.c with this demo has\r
86  * Change_PSW_PM_to_UserMode() commented out to ensure this is the case.\r
87  *\r
88  * *NOTE 4* The IntQueue common demo tasks test interrupt nesting and make use\r
89  * of all the 8bit timers (as two cascaded 16bit units).\r
90 */\r
91 \r
92 /* Hardware specific includes. */\r
93 #include "iodefine.h"\r
94 \r
95 /* Kernel includes. */\r
96 #include "FreeRTOS.h"\r
97 #include "task.h"\r
98 #include "timers.h"\r
99 #include "semphr.h"\r
100 \r
101 /* Standard demo includes. */\r
102 #include "partest.h"\r
103 #include "flash.h"\r
104 #include "IntQueue.h"\r
105 #include "BlockQ.h"\r
106 #include "death.h"\r
107 #include "integer.h"\r
108 #include "blocktim.h"\r
109 #include "semtest.h"\r
110 #include "PollQ.h"\r
111 #include "GenQTest.h"\r
112 #include "QPeek.h"\r
113 #include "recmutex.h"\r
114 #include "flop.h"\r
115 \r
116 /* Values that are passed into the reg test tasks using the task parameter.  The\r
117 tasks check that the values are passed in correctly. */\r
118 #define mainREG_TEST_1_PARAMETER        ( 0x12121212UL )\r
119 #define mainREG_TEST_2_PARAMETER        ( 0x12345678UL )\r
120 \r
121 /* Priorities at which the tasks are created. */\r
122 #define mainQUEUE_POLL_PRIORITY         ( tskIDLE_PRIORITY + 1 )\r
123 #define mainSEM_TEST_PRIORITY           ( tskIDLE_PRIORITY + 1 )\r
124 #define mainBLOCK_Q_PRIORITY            ( tskIDLE_PRIORITY + 2 )\r
125 #define mainCREATOR_TASK_PRIORITY   ( tskIDLE_PRIORITY + 3 )\r
126 #define mainFLASH_TASK_PRIORITY         ( tskIDLE_PRIORITY + 1 )\r
127 #define mainINTEGER_TASK_PRIORITY   ( tskIDLE_PRIORITY )\r
128 #define mainGEN_QUEUE_TASK_PRIORITY     ( tskIDLE_PRIORITY )\r
129 #define mainFLOP_TASK_PRIORITY          ( tskIDLE_PRIORITY )\r
130 \r
131 /* The LED toggled by the check timer. */\r
132 #define mainCHECK_LED                           ( 3 )\r
133 \r
134 /* The period at which the check timer will expire, in ms, provided no errors\r
135 have been reported by any of the standard demo tasks.  ms are converted to the\r
136 equivalent in ticks using the portTICK_PERIOD_MS constant. */\r
137 #define mainCHECK_TIMER_PERIOD_MS                       ( 5000UL / portTICK_PERIOD_MS )\r
138 \r
139 /* The period at which the check timer will expire, in ms, if an error has been\r
140 reported in one of the standard demo tasks.  ms are converted to the equivalent\r
141 in ticks using the portTICK_PERIOD_MS constant. */\r
142 #define mainERROR_CHECK_TIMER_PERIOD_MS         ( 200UL / portTICK_PERIOD_MS )\r
143 \r
144 /* A block time of zero simple means "Don't Block". */\r
145 #define mainDONT_BLOCK                          ( 0UL )\r
146 \r
147 /*\r
148  * vApplicationMallocFailedHook() will only be called if\r
149  * configUSE_MALLOC_FAILED_HOOK is set to 1 in FreeRTOSConfig.h.  It is a hook\r
150  * function that will execute if a call to pvPortMalloc() fails.\r
151  * pvPortMalloc() is called internally by the kernel whenever a task, queue or\r
152  * semaphore is created.  It is also called by various parts of the demo\r
153  * application.\r
154  */\r
155 void vApplicationMallocFailedHook( void );\r
156 \r
157 /*\r
158  * vApplicationIdleHook() will only be called if configUSE_IDLE_HOOK is set to 1\r
159  * in FreeRTOSConfig.h.  It is a hook function that is called on each iteration\r
160  * of the idle task.  It is essential that code added to this hook function\r
161  * never attempts to block in any way (for example, call xQueueReceive() with\r
162  * a block time specified).  If the application makes use of the vTaskDelete()\r
163  * API function (as this demo application does) then it is also important that\r
164  * vApplicationIdleHook() is permitted to return to its calling function because\r
165  * it is the responsibility of the idle task to clean up memory allocated by the\r
166  * kernel to any task that has since been deleted.\r
167  */\r
168 void vApplicationIdleHook( void );\r
169 \r
170 /*\r
171  * vApplicationStackOverflowHook() will only be called if\r
172  * configCHECK_FOR_STACK_OVERFLOW is set to a non-zero value.  The handle and\r
173  * name of the offending task should be passed in the function parameters, but\r
174  * it is possible that the stack overflow will have corrupted these - in which\r
175  * case pxCurrentTCB can be inspected to find the same information.\r
176  */\r
177 void vApplicationStackOverflowHook( TaskHandle_t pxTask, char *pcTaskName );\r
178 \r
179 /*\r
180  * The reg test tasks as described at the top of this file.\r
181  */\r
182 static void prvRegTest1Task( void *pvParameters );\r
183 static void prvRegTest2Task( void *pvParameters );\r
184 \r
185 /*\r
186  * The actual implementation of the reg test functionality, which, because of\r
187  * the direct register access, have to be in assembly.\r
188  */\r
189 static void prvRegTest1Implementation( void );\r
190 static void prvRegTest2Implementation( void );\r
191 \r
192 /*\r
193  * The check timer callback function, as described at the top of this file.\r
194  */\r
195 static void prvCheckTimerCallback( TimerHandle_t xTimer );\r
196 \r
197 \r
198 /*-----------------------------------------------------------*/\r
199 \r
200 /* Variables that are incremented on each iteration of the reg test tasks -\r
201 provided the tasks have not reported any errors.  The check timer inspects these\r
202 variables to ensure they are still incrementing as expected.  If a variable\r
203 stops incrementing then it is likely that its associate task has stalled. */\r
204 unsigned long ulRegTest1CycleCount = 0UL, ulRegTest2CycleCount = 0UL;\r
205 \r
206 /* The check timer.  This uses prvCheckTimerCallback() as its callback\r
207 function. */\r
208 static TimerHandle_t xCheckTimer = NULL;\r
209 \r
210 /*-----------------------------------------------------------*/\r
211 \r
212 void main(void)\r
213 {\r
214 extern void HardwareSetup( void );\r
215 \r
216         /* Renesas provided CPU configuration routine.  The clocks are configured in\r
217         here. */\r
218         HardwareSetup();\r
219 \r
220         /* Turn all LEDs off. */\r
221         vParTestInitialise();\r
222 \r
223         /* Start the reg test tasks which test the context switching mechanism. */\r
224         xTaskCreate( prvRegTest1Task, "RegTst1", configMINIMAL_STACK_SIZE, ( void * ) mainREG_TEST_1_PARAMETER, tskIDLE_PRIORITY, NULL );\r
225         xTaskCreate( prvRegTest2Task, "RegTst2", configMINIMAL_STACK_SIZE, ( void * ) mainREG_TEST_2_PARAMETER, tskIDLE_PRIORITY, NULL );\r
226 \r
227         /* Create the standard demo tasks. */\r
228         vStartBlockingQueueTasks( mainBLOCK_Q_PRIORITY );\r
229         vCreateBlockTimeTasks();\r
230         vStartSemaphoreTasks( mainSEM_TEST_PRIORITY );\r
231         vStartPolledQueueTasks( mainQUEUE_POLL_PRIORITY );\r
232         vStartIntegerMathTasks( mainINTEGER_TASK_PRIORITY );\r
233         vStartGenericQueueTasks( mainGEN_QUEUE_TASK_PRIORITY );\r
234         vStartLEDFlashTasks( mainFLASH_TASK_PRIORITY );\r
235         vStartQueuePeekTasks();\r
236         vStartRecursiveMutexTasks();\r
237         vStartInterruptQueueTasks();\r
238         vStartMathTasks( mainFLOP_TASK_PRIORITY );\r
239 \r
240         /* The suicide tasks must be created last as they need to know how many\r
241         tasks were running prior to their creation in order to ascertain whether\r
242         or not the correct/expected number of tasks are running at any given time. */\r
243         vCreateSuicidalTasks( mainCREATOR_TASK_PRIORITY );\r
244 \r
245         /* Create the software timer that performs the 'check' functionality,\r
246         as described at the top of this file. */\r
247         xCheckTimer = xTimerCreate( "CheckTimer",/* A text name, purely to help debugging. */\r
248                                                                 ( mainCHECK_TIMER_PERIOD_MS ),          /* The timer period, in this case 5000ms (5s). */\r
249                                                                 pdTRUE,                                                         /* This is an auto-reload timer, so xAutoReload is set to pdTRUE. */\r
250                                                                 ( void * ) 0,                                           /* The ID is not used, so can be set to anything. */\r
251                                                                 prvCheckTimerCallback                           /* The callback function that inspects the status of all the other tasks. */\r
252                                                           );\r
253                                                           \r
254         /* Sanity check that the check timer was indeed created. */\r
255         configASSERT( xCheckTimer );\r
256         \r
257         /* Start the check timer.  It will actually start when the scheduler is\r
258         started. */\r
259         xTimerStart( xCheckTimer, mainDONT_BLOCK );\r
260 \r
261         /* Start the tasks running. */\r
262         vTaskStartScheduler();\r
263 \r
264         /* If all is well, the following line will never be reached as the scheduler \r
265         will be running.  If the following line is reached, there was insufficient\r
266         FreeRTOS heap available for the idle task to be created.  See\r
267         http://www.freertos.org/a00111.html and the malloc failed hook function for\r
268         more information. */\r
269         for( ;; );\r
270 }\r
271 /*-----------------------------------------------------------*/\r
272 \r
273 static void prvCheckTimerCallback( TimerHandle_t xTimer )\r
274 {\r
275 static long lChangedTimerPeriodAlready = pdFALSE, lErrorStatus = pdPASS;\r
276 static volatile unsigned long ulLastRegTest1CycleCount = 0UL, ulLastRegTest2CycleCount = 0UL;\r
277 \r
278         /* Check the standard demo tasks are running without error. */\r
279         if( xAreGenericQueueTasksStillRunning() != pdTRUE )\r
280         {\r
281                 lErrorStatus = pdFAIL;\r
282         }\r
283         else if( xAreQueuePeekTasksStillRunning() != pdTRUE )\r
284         {\r
285                 lErrorStatus = pdFAIL;\r
286         }\r
287         else if( xAreBlockingQueuesStillRunning() != pdTRUE )\r
288         {\r
289                 lErrorStatus = pdFAIL;\r
290         }\r
291         else if( xAreBlockTimeTestTasksStillRunning() != pdTRUE )\r
292         {\r
293                 lErrorStatus = pdFAIL;\r
294         }\r
295         else if( xAreSemaphoreTasksStillRunning() != pdTRUE )\r
296         {\r
297                 lErrorStatus = pdFAIL;\r
298         }\r
299         else if( xArePollingQueuesStillRunning() != pdTRUE )\r
300         {\r
301                 lErrorStatus = pdFAIL;\r
302         }\r
303         else if( xIsCreateTaskStillRunning() != pdTRUE )\r
304         {\r
305                 lErrorStatus = pdFAIL;\r
306         }\r
307         else if( xAreIntegerMathsTaskStillRunning() != pdTRUE )\r
308         {\r
309                 lErrorStatus = pdFAIL;\r
310         }\r
311         else if( xAreRecursiveMutexTasksStillRunning() != pdTRUE )\r
312         {\r
313                 lErrorStatus = pdFAIL;\r
314         }\r
315         else if( xAreIntQueueTasksStillRunning() != pdPASS )\r
316         {\r
317                 lErrorStatus = pdFAIL;\r
318         }\r
319         else if( xAreMathsTaskStillRunning() != pdPASS )\r
320         {\r
321                 lErrorStatus = pdFAIL;\r
322         }\r
323 \r
324         /* Check the reg test tasks are still cycling.  They will stop incrementing\r
325         their loop counters if they encounter an error. */\r
326         if( ulRegTest1CycleCount == ulLastRegTest1CycleCount )\r
327         {\r
328                 lErrorStatus = pdFAIL;\r
329         }\r
330 \r
331         if( ulRegTest2CycleCount == ulLastRegTest2CycleCount )\r
332         {\r
333                 lErrorStatus = pdFAIL;\r
334         }\r
335 \r
336         ulLastRegTest1CycleCount = ulRegTest1CycleCount;\r
337         ulLastRegTest2CycleCount = ulRegTest2CycleCount;\r
338 \r
339         /* Toggle the check LED to give an indication of the system status.  If\r
340         the LED toggles every 5 seconds then everything is ok.  A faster toggle\r
341         indicates an error. */\r
342         vParTestToggleLED( mainCHECK_LED );\r
343         \r
344         /* Was an error detected this time through the callback execution? */\r
345         if( lErrorStatus != pdPASS )\r
346         {\r
347                 if( lChangedTimerPeriodAlready == pdFALSE )\r
348                 {\r
349                         lChangedTimerPeriodAlready = pdTRUE;\r
350                         \r
351                         /* This call to xTimerChangePeriod() uses a zero block time.  \r
352                         Functions called from inside of a timer callback function must \r
353                         *never* attempt to block. */\r
354                         xTimerChangePeriod( xCheckTimer, ( mainERROR_CHECK_TIMER_PERIOD_MS ), mainDONT_BLOCK );\r
355                 }\r
356         }\r
357 }\r
358 /*-----------------------------------------------------------*/\r
359 \r
360 /* The RX port uses this callback function to configure its tick interrupt.\r
361 This allows the application to choose the tick interrupt source. */\r
362 void vApplicationSetupTimerInterrupt( void )\r
363 {\r
364         /* Enable compare match timer 0. */\r
365         MSTP( CMT0 ) = 0;\r
366 \r
367         /* Interrupt on compare match. */\r
368         CMT0.CMCR.BIT.CMIE = 1;\r
369 \r
370         /* Set the compare match value. */\r
371         CMT0.CMCOR = ( unsigned short ) ( ( ( configPERIPHERAL_CLOCK_HZ / configTICK_RATE_HZ ) -1 ) / 8 );\r
372 \r
373         /* Divide the PCLK by 8. */\r
374         CMT0.CMCR.BIT.CKS = 0;\r
375 \r
376         /* Enable the interrupt... */\r
377         _IEN( _CMT0_CMI0 ) = 1;\r
378 \r
379         /* ...and set its priority to the application defined kernel priority. */\r
380         _IPR( _CMT0_CMI0 ) = configKERNEL_INTERRUPT_PRIORITY;\r
381 \r
382         /* Start the timer. */\r
383         CMT.CMSTR0.BIT.STR0 = 1;\r
384 }\r
385 /*-----------------------------------------------------------*/\r
386 \r
387 /* This function is explained by the comments above its prototype at the top\r
388 of this file. */\r
389 void vApplicationMallocFailedHook( void )\r
390 {\r
391         for( ;; );\r
392 }\r
393 /*-----------------------------------------------------------*/\r
394 \r
395 /* This function is explained by the comments above its prototype at the top\r
396 of this file. */\r
397 void vApplicationStackOverflowHook( TaskHandle_t pxTask, char *pcTaskName )\r
398 {\r
399         for( ;; );\r
400 }\r
401 /*-----------------------------------------------------------*/\r
402 \r
403 /* This function is explained by the comments above its prototype at the top\r
404 of this file. */\r
405 void vApplicationIdleHook( void )\r
406 {\r
407         /* If this is being executed then the kernel has been started.  Start the high\r
408         frequency timer test as described at the top of this file.  This is only\r
409         included in the optimised build configuration - otherwise it takes up too much\r
410         CPU time and can disrupt other tests. */\r
411         #ifdef INCLUDE_HIGH_FREQUENCY_TIMER_TEST\r
412         static portBASE_TYPE xTimerTestStarted = pdFALSE;\r
413         extern void vSetupHighFrequencyTimer( void );\r
414                 if( xTimerTestStarted == pdFALSE )\r
415                 {\r
416                         vSetupHighFrequencyTimer();\r
417                         xTimerTestStarted = pdTRUE;\r
418                 }\r
419         #endif\r
420 }\r
421 /*-----------------------------------------------------------*/\r
422 \r
423 /* This function is explained in the comments at the top of this file. */\r
424 static void prvRegTest1Task( void *pvParameters )\r
425 {\r
426         if( ( ( unsigned long ) pvParameters ) != mainREG_TEST_1_PARAMETER )\r
427         {\r
428                 /* The parameter did not contain the expected value. */\r
429                 for( ;; )\r
430                 {\r
431                         /* Stop the tick interrupt so its obvious something has gone wrong. */\r
432                         taskDISABLE_INTERRUPTS();\r
433                 }\r
434         }\r
435 \r
436         /* This is an inline asm function that never returns. */\r
437         prvRegTest1Implementation();\r
438 }\r
439 /*-----------------------------------------------------------*/\r
440 \r
441 /* This function is explained in the comments at the top of this file. */\r
442 static void prvRegTest2Task( void *pvParameters )\r
443 {\r
444         if( ( ( unsigned long ) pvParameters ) != mainREG_TEST_2_PARAMETER )\r
445         {\r
446                 /* The parameter did not contain the expected value. */\r
447                 for( ;; )\r
448                 {\r
449                         /* Stop the tick interrupt so its obvious something has gone wrong. */\r
450                         taskDISABLE_INTERRUPTS();\r
451                 }\r
452         }\r
453 \r
454         /* This is an inline asm function that never returns. */\r
455         prvRegTest2Implementation();\r
456 }\r
457 /*-----------------------------------------------------------*/\r
458 \r
459 /* This function is explained in the comments at the top of this file. */\r
460 #pragma inline_asm prvRegTest1Implementation\r
461 static void prvRegTest1Implementation( void )\r
462 {\r
463         ; Put a known value in each register.\r
464         MOV.L   #1, R1\r
465         MOV.L   #2, R2\r
466         MOV.L   #3, R3\r
467         MOV.L   #4, R4\r
468         MOV.L   #5, R5\r
469         MOV.L   #6, R6\r
470         MOV.L   #7, R7\r
471         MOV.L   #8, R8\r
472         MOV.L   #9, R9\r
473         MOV.L   #10, R10\r
474         MOV.L   #11, R11\r
475         MOV.L   #12, R12\r
476         MOV.L   #13, R13\r
477         MOV.L   #14, R14\r
478         MOV.L   #15, R15\r
479 \r
480         ; Loop, checking each iteration that each register still contains the\r
481         ; expected value.\r
482 TestLoop1:\r
483 \r
484         ; Push the registers that are going to get clobbered.\r
485         PUSHM   R14-R15\r
486 \r
487         ; Increment the loop counter to show this task is still getting CPU time.\r
488         MOV.L   #_ulRegTest1CycleCount, R14\r
489         MOV.L   [ R14 ], R15\r
490         ADD             #1, R15\r
491         MOV.L   R15, [ R14 ]\r
492 \r
493         ; Yield to extend the text coverage.  Set the bit in the ITU SWINTR register.\r
494         MOV.L   #1, R14\r
495         MOV.L   #0872E0H, R15\r
496         MOV.B   R14, [R15]\r
497         NOP\r
498         NOP\r
499 \r
500         ; Restore the clobbered registers.\r
501         POPM    R14-R15\r
502 \r
503         ; Now compare each register to ensure it still contains the value that was\r
504         ; set before this loop was entered.\r
505         CMP             #1, R1\r
506         BNE             RegTest1Error\r
507         CMP             #2, R2\r
508         BNE             RegTest1Error\r
509         CMP             #3, R3\r
510         BNE             RegTest1Error\r
511         CMP             #4, R4\r
512         BNE             RegTest1Error\r
513         CMP             #5, R5\r
514         BNE             RegTest1Error\r
515         CMP             #6, R6\r
516         BNE             RegTest1Error\r
517         CMP             #7, R7\r
518         BNE             RegTest1Error\r
519         CMP             #8, R8\r
520         BNE             RegTest1Error\r
521         CMP             #9, R9\r
522         BNE             RegTest1Error\r
523         CMP             #10, R10\r
524         BNE             RegTest1Error\r
525         CMP             #11, R11\r
526         BNE             RegTest1Error\r
527         CMP             #12, R12\r
528         BNE             RegTest1Error\r
529         CMP             #13, R13\r
530         BNE             RegTest1Error\r
531         CMP             #14, R14\r
532         BNE             RegTest1Error\r
533         CMP             #15, R15\r
534         BNE             RegTest1Error\r
535 \r
536         ; All comparisons passed, start a new itteratio of this loop.\r
537         BRA             TestLoop1\r
538 \r
539 RegTest1Error:\r
540         ; A compare failed, just loop here so the loop counter stops incrementing\r
541         ; causing the check timer to indicate the error.\r
542         BRA RegTest1Error\r
543 }\r
544 /*-----------------------------------------------------------*/\r
545 \r
546 /* This function is explained in the comments at the top of this file. */\r
547 #pragma inline_asm prvRegTest2Implementation\r
548 static void prvRegTest2Implementation( void )\r
549 {\r
550         ; Put a known value in each register.\r
551         MOV.L   #10, R1\r
552         MOV.L   #20, R2\r
553         MOV.L   #30, R3\r
554         MOV.L   #40, R4\r
555         MOV.L   #50, R5\r
556         MOV.L   #60, R6\r
557         MOV.L   #70, R7\r
558         MOV.L   #80, R8\r
559         MOV.L   #90, R9\r
560         MOV.L   #100, R10\r
561         MOV.L   #110, R11\r
562         MOV.L   #120, R12\r
563         MOV.L   #130, R13\r
564         MOV.L   #140, R14\r
565         MOV.L   #150, R15\r
566 \r
567         ; Loop, checking on each iteration that each register still contains the\r
568         ; expected value.\r
569 TestLoop2:\r
570 \r
571         ; Push the registers that are going to get clobbered.\r
572         PUSHM   R14-R15\r
573 \r
574         ; Increment the loop counter to show this task is still getting CPU time.\r
575         MOV.L   #_ulRegTest2CycleCount, R14\r
576         MOV.L   [ R14 ], R15\r
577         ADD             #1, R15\r
578         MOV.L   R15, [ R14 ]\r
579 \r
580         ; Restore the clobbered registers.\r
581         POPM    R14-R15\r
582 \r
583         CMP             #10, R1\r
584         BNE             RegTest2Error\r
585         CMP             #20, R2\r
586         BNE             RegTest2Error\r
587         CMP             #30, R3\r
588         BNE             RegTest2Error\r
589         CMP             #40, R4\r
590         BNE             RegTest2Error\r
591         CMP             #50, R5\r
592         BNE             RegTest2Error\r
593         CMP             #60, R6\r
594         BNE             RegTest2Error\r
595         CMP             #70, R7\r
596         BNE             RegTest2Error\r
597         CMP             #80, R8\r
598         BNE             RegTest2Error\r
599         CMP             #90, R9\r
600         BNE             RegTest2Error\r
601         CMP             #100, R10\r
602         BNE             RegTest2Error\r
603         CMP             #110, R11\r
604         BNE             RegTest2Error\r
605         CMP             #120, R12\r
606         BNE             RegTest2Error\r
607         CMP             #130, R13\r
608         BNE             RegTest2Error\r
609         CMP             #140, R14\r
610         BNE             RegTest2Error\r
611         CMP             #150, R15\r
612         BNE             RegTest2Error\r
613 \r
614         ; All comparisons passed, start a new itteratio of this loop.\r
615         BRA             TestLoop2\r
616 \r
617 RegTest2Error:\r
618         ; A compare failed, just loop here so the loop counter stops incrementing\r
619         ; - causing the check timer to indicate the error.\r
620         BRA RegTest2Error\r
621 }\r
622 /*-----------------------------------------------------------*/\r
623 \r