OpenCores
URL https://opencores.org/ocsvn/openrisc/openrisc/trunk

Subversion Repositories openrisc

[/] [openrisc/] [trunk/] [rtos/] [freertos-6.1.1/] [Demo/] [CORTEX_LM3S102_Rowley/] [Demo2/] [main.c] - Blame information for rev 581

Details | Compare with Previous | View Log

Line No. Rev Author Line
1 581 jeremybenn
/*
2
    FreeRTOS V6.1.1 - Copyright (C) 2011 Real Time Engineers Ltd.
3
 
4
    ***************************************************************************
5
    *                                                                         *
6
    * If you are:                                                             *
7
    *                                                                         *
8
    *    + New to FreeRTOS,                                                   *
9
    *    + Wanting to learn FreeRTOS or multitasking in general quickly       *
10
    *    + Looking for basic training,                                        *
11
    *    + Wanting to improve your FreeRTOS skills and productivity           *
12
    *                                                                         *
13
    * then take a look at the FreeRTOS books - available as PDF or paperback  *
14
    *                                                                         *
15
    *        "Using the FreeRTOS Real Time Kernel - a Practical Guide"        *
16
    *                  http://www.FreeRTOS.org/Documentation                  *
17
    *                                                                         *
18
    * A pdf reference manual is also available.  Both are usually delivered   *
19
    * to your inbox within 20 minutes to two hours when purchased between 8am *
20
    * and 8pm GMT (although please allow up to 24 hours in case of            *
21
    * exceptional circumstances).  Thank you for your support!                *
22
    *                                                                         *
23
    ***************************************************************************
24
 
25
    This file is part of the FreeRTOS distribution.
26
 
27
    FreeRTOS is free software; you can redistribute it and/or modify it under
28
    the terms of the GNU General Public License (version 2) as published by the
29
    Free Software Foundation AND MODIFIED BY the FreeRTOS exception.
30
    ***NOTE*** The exception to the GPL is included to allow you to distribute
31
    a combined work that includes FreeRTOS without being obliged to provide the
32
    source code for proprietary components outside of the FreeRTOS kernel.
33
    FreeRTOS is distributed in the hope that it will be useful, but WITHOUT
34
    ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
35
    FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
36
    more details. You should have received a copy of the GNU General Public
37
    License and the FreeRTOS license exception along with FreeRTOS; if not it
38
    can be viewed here: http://www.freertos.org/a00114.html and also obtained
39
    by writing to Richard Barry, contact details for whom are available on the
40
    FreeRTOS WEB site.
41
 
42
    1 tab == 4 spaces!
43
 
44
    http://www.FreeRTOS.org - Documentation, latest information, license and
45
    contact details.
46
 
47
    http://www.SafeRTOS.com - A version that is certified for use in safety
48
    critical systems.
49
 
50
    http://www.OpenRTOS.com - Commercial support, development, porting,
51
    licensing and training services.
52
*/
53
 
54
/*
55
 * This demo application creates seven co-routines and one task (two including
56
 * the idle task).  The co-routines execute as part of the idle task hook.
57
 *
58
 * Five of the created co-routines are the standard 'co-routine flash'
59
 * co-routines contained within the Demo/Common/Minimal/crflash.c file and
60
 * documented on the FreeRTOS.org WEB site.
61
 *
62
 * The 'LCD Task' rotates a string on the LCD, delaying between each character
63
 * as necessitated by the slow interface, and delaying between each string just
64
 * long enough to enable the text to be read.
65
 *
66
 * The sixth co-routine controls the transmission of a string to UART 0.  The
67
 * co-routine periodically sends the first character of the string to the UART,
68
 * with the UART's TxEnd interrupt being used to transmit the remaining
69
 * characters.  The UART's RxEnd interrupt receives the characters and places
70
 * them on a queue to be processed by the seventh and final co-routine.  An
71
 * error is latched should an unexpected character be received, or any
72
 * character be received out of sequence.
73
 *
74
 * A loopback connector is required to ensure that each character transmitted
75
 * on the UART is also received on the same UART.  For test purposes the UART
76
 * FIFO's are not utalised in order to maximise the interrupt overhead.  Also
77
 * a pseudo random interval is used between the start of each transmission in
78
 * order that the resultant interrupts are more randomly distributed and
79
 * therefore more likely to highlight any problems.
80
 *
81
 * The flash co-routines control LED's zero to four.  LED five is toggled each
82
 * time the string is transmitted on the UART.  LED six is toggled each time
83
 * the string is CORRECTLY received on the UART.  LED seven is latched on should
84
 * an error be detected in any task or co-routine.
85
 *
86
 * In addition the idle task makes repetative calls to
87
 * prvSetAndCheckRegisters().  This simply loads the general purpose registers
88
 * with a known value, then checks each register to ensure the held value is
89
 * still correct.  As a low priority task this checking routine is likely to
90
 * get repeatedly swapped in and out.  A register being found to contain an
91
 * incorrect value is therefore indicative of an error in the task switching
92
 * mechansim.
93
 *
94
 */
95
 
96
/* Scheduler include files. */
97
#include "FreeRTOS.h"
98
#include "task.h"
99
#include "queue.h"
100
#include "croutine.h"
101
 
102
/* Demo application include files. */
103
#include "partest.h"
104
#include "crflash.h"
105
 
106
/* Library include files. */
107
#include "DriverLib.h"
108
 
109
/* The time to delay between writing each character to the LCD. */
110
#define mainCHAR_WRITE_DELAY            ( 2 / portTICK_RATE_MS )
111
 
112
/* The time to delay between writing each string to the LCD. */
113
#define mainSTRING_WRITE_DELAY          ( 400 / portTICK_RATE_MS )
114
 
115
/* The number of flash co-routines to create. */
116
#define mainNUM_FLASH_CO_ROUTINES       ( 5 )
117
 
118
/* The length of the queue used to pass received characters to the Comms Rx
119
task. */
120
#define mainRX_QUEUE_LEN                        ( 5 )
121
 
122
/* The priority of the co-routine used to initiate the transmission of the
123
string on UART 0. */
124
#define mainTX_CO_ROUTINE_PRIORITY      ( 1 )
125
 
126
/* The priority of the co-routine used to receive characters from the UART. */
127
#define mainRX_CO_ROUTINE_PRIORITY      ( 2 )
128
 
129
/* Only one co-routine is created so its index is not important. */
130
#define mainTX_CO_ROUTINE_INDEX         ( 0 )
131
#define mainRX_CO_ROUTINE_INDEX         ( 0 )
132
 
133
/* The time between transmissions of the string on UART 0.   This is pseudo
134
random in order to generate a bit or randomness to when the interrupts occur.*/
135
#define mainMIN_TX_DELAY                        ( 40 / portTICK_RATE_MS )
136
#define mainMAX_TX_DELAY                        ( ( portTickType ) 0x7f )
137
#define mainOFFSET_TIME                         ( ( portTickType ) 3 )
138
 
139
/* The time the Comms Rx task should wait to receive a character.  This should
140
be slightly longer than the time between transmissions.  If we do not receive
141
a character after this time then there must be an error in the transmission or
142
the timing of the transmission. */
143
#define mainCOMMS_RX_DELAY                      ( mainMAX_TX_DELAY + 20 )
144
 
145
/* The task priorites. */
146
#define mainLCD_TASK_PRIORITY           ( tskIDLE_PRIORITY )
147
#define mainCOMMS_RX_TASK_PRIORITY      ( tskIDLE_PRIORITY + 1 )
148
 
149
/* The LED's toggled by the various tasks. */
150
#define mainCOMMS_FAIL_LED                      ( 7 )
151
#define mainCOMMS_RX_LED                        ( 6 )
152
#define mainCOMMS_TX_LED                        ( 5 )
153
 
154
/* The baud rate used by the UART comms tasks/co-routine. */
155
#define mainBAUD_RATE                           ( 57600 )
156
 
157
/* FIFO setting for the UART.  The FIFO is not used to create a better test. */
158
#define mainFIFO_SET                            ( 0x10 )
159
 
160
/* The string that is transmitted on the UART contains sequentially the
161
characters from mainFIRST_TX_CHAR to mainLAST_TX_CHAR. */
162
#define mainFIRST_TX_CHAR '0'
163
#define mainLAST_TX_CHAR 'z'
164
 
165
/* Just used to walk through the program memory in order that some random data
166
can be generated. */
167
#define mainTOTAL_PROGRAM_MEMORY ( ( unsigned long * ) ( 8 * 1024 ) )
168
#define mainFIRST_PROGRAM_BYTES ( ( unsigned long * ) 4 )
169
 
170
/* The error routine that is called if the driver library encounters an error. */
171
#ifdef DEBUG
172
void
173
__error__(char *pcFilename, unsigned long ulLine)
174
{
175
}
176
#endif
177
 
178
/*-----------------------------------------------------------*/
179
 
180
/*
181
 * The task that rotates text on the LCD.
182
 */
183
static void vLCDTask( void * pvParameters );
184
 
185
/*
186
 * The task that receives the characters from UART 0.
187
 */
188
static void vCommsRxCoRoutine( xCoRoutineHandle xHandle, unsigned portBASE_TYPE uxIndex );
189
 
190
/*
191
 * The co-routine that periodically initiates the transmission of the string on
192
 * the UART.
193
 */
194
static void vSerialTxCoRoutine( xCoRoutineHandle xHandle, unsigned portBASE_TYPE uxIndex );
195
 
196
/*
197
 * Writes a string the the LCD.
198
 */
199
static void prvWriteString( const char *pcString );
200
 
201
/*
202
 * Initialisation routine for the UART.
203
 */
204
static void vSerialInit( void );
205
 
206
/*
207
 * Thread safe write to the PDC.
208
 */
209
static void prvPDCWrite( char cAddress, char cData );
210
 
211
/*
212
 * Function to simply set a known value into the general purpose registers
213
 * then read them back to ensure they remain set correctly.  An incorrect value
214
 * being indicative of an error in the task switching mechanism.
215
 */
216
void prvSetAndCheckRegisters( void );
217
 
218
/*
219
 * Latch the LED that indicates that an error has occurred.
220
 */
221
void vSetErrorLED( void );
222
 
223
/*
224
 * Sets up the PLL and ports used by the demo.
225
 */
226
static void prvSetupHardware( void );
227
 
228
/*-----------------------------------------------------------*/
229
 
230
/* Error flag set to pdFAIL if an error is encountered in the tasks/co-routines
231
defined within this file. */
232
unsigned portBASE_TYPE uxErrorStatus = pdPASS;
233
 
234
/* The next character to transmit. */
235
static char cNextChar;
236
 
237
/* The queue used to transmit characters from the interrupt to the Comms Rx
238
task. */
239
static xQueueHandle xCommsQueue;
240
 
241
/*-----------------------------------------------------------*/
242
 
243
int main( void )
244
{
245
        /* Create the queue used to communicate between the UART ISR and the Comms
246
        Rx task. */
247
        xCommsQueue = xQueueCreate( mainRX_QUEUE_LEN, sizeof( char ) );
248
 
249
        /* Setup the ports used by the demo and the clock. */
250
        prvSetupHardware();
251
 
252
        /* Create the co-routines that flash the LED's. */
253
        vStartFlashCoRoutines( mainNUM_FLASH_CO_ROUTINES );
254
 
255
        /* Create the co-routine that initiates the transmission of characters
256
        on the UART. */
257
        xCoRoutineCreate( vSerialTxCoRoutine, mainTX_CO_ROUTINE_PRIORITY, mainTX_CO_ROUTINE_INDEX );
258
 
259
        /* Create the co-routine that receives characters from the UART. */
260
        xCoRoutineCreate( vCommsRxCoRoutine, mainRX_CO_ROUTINE_PRIORITY, mainRX_CO_ROUTINE_INDEX );
261
 
262
        /* Create the LCD task. */
263
        xTaskCreate( vLCDTask, "LCD", configMINIMAL_STACK_SIZE, NULL, mainLCD_TASK_PRIORITY, NULL );
264
 
265
        /* Start the scheduler running the tasks and co-routines just created. */
266
        vTaskStartScheduler();
267
 
268
        /* Should not get here unless we did not have enough memory to start the
269
        scheduler. */
270
        for( ;; );
271
        return 0;
272
}
273
/*-----------------------------------------------------------*/
274
 
275
static void prvSetupHardware( void )
276
{
277
        /* Setup the PLL. */
278
        SysCtlClockSet( SYSCTL_SYSDIV_10 | SYSCTL_USE_PLL | SYSCTL_OSC_MAIN | SYSCTL_XTAL_6MHZ );
279
 
280
        /* Initialise the hardware used to talk to the LCD, LED's and UART. */
281
        PDCInit();
282
        vParTestInitialise();
283
        vSerialInit();
284
}
285
/*-----------------------------------------------------------*/
286
 
287
void vApplicationIdleHook( void )
288
{
289
        /* The co-routines are executed in the idle task using the idle task
290
        hook. */
291
        for( ;; )
292
        {
293
                /* Schedule the co-routines. */
294
                vCoRoutineSchedule();
295
 
296
                /* Run the register check function between each co-routine. */
297
                prvSetAndCheckRegisters();
298
        }
299
}
300
/*-----------------------------------------------------------*/
301
 
302
static void prvWriteString( const char *pcString )
303
{
304
        /* Write pcString to the LED, pausing between each character. */
305
        prvPDCWrite(PDC_LCD_CSR, LCD_CLEAR);
306
        while( *pcString )
307
        {
308
                vTaskDelay( mainCHAR_WRITE_DELAY );
309
                prvPDCWrite( PDC_LCD_RAM, *pcString );
310
                pcString++;
311
        }
312
}
313
/*-----------------------------------------------------------*/
314
 
315
void vLCDTask( void * pvParameters )
316
{
317
unsigned portBASE_TYPE uxIndex;
318
const unsigned char ucCFGData[] = {
319
                                                                                        0x30,   /* Set data bus to 8-bits. */
320
                                                                                        0x30,
321
                                                                                        0x30,
322
                                                                                        0x3C,   /* Number of lines/font. */
323
                                                                                        0x08,   /* Display off. */
324
                                                                                        0x01,   /* Display clear. */
325
                                                                                        0x06,   /* Entry mode [cursor dir][shift]. */
326
                                                                                        0x0C    /* Display on [display on][curson on][blinking on]. */
327
                                                                          };
328
 
329
/* The strings that are written to the LCD. */
330
const char *pcStringsToDisplay[] = {
331
                                                                                        "Stellaris",
332
                                                                                        "Demo",
333
                                                                                        "Two",
334
                                                                                        "www.FreeRTOS.org",
335
                                                                                        ""
336
                                                                           };
337
 
338
        /* Configure the LCD. */
339
        uxIndex = 0;
340
        while( uxIndex < sizeof( ucCFGData ) )
341
        {
342
                prvPDCWrite( PDC_LCD_CSR, ucCFGData[ uxIndex ] );
343
                uxIndex++;
344
                vTaskDelay( mainCHAR_WRITE_DELAY );
345
        }
346
 
347
        /* Turn the LCD Backlight on. */
348
        prvPDCWrite( PDC_CSR, 0x01 );
349
 
350
        /* Clear display. */
351
        vTaskDelay( mainCHAR_WRITE_DELAY );
352
        prvPDCWrite( PDC_LCD_CSR, LCD_CLEAR );
353
 
354
        uxIndex = 0;
355
        for( ;; )
356
        {
357
                /* Display the string on the LCD. */
358
                prvWriteString( pcStringsToDisplay[ uxIndex ] );
359
 
360
                /* Move on to the next string - wrapping if necessary. */
361
                uxIndex++;
362
                if( *( pcStringsToDisplay[ uxIndex ] ) == 0x00 )
363
                {
364
                        uxIndex = 0;
365
                        /* Longer pause on the last string to be sent. */
366
                        vTaskDelay( mainSTRING_WRITE_DELAY * 2 );
367
                }
368
 
369
                /* Wait until it is time to move onto the next string. */
370
                vTaskDelay( mainSTRING_WRITE_DELAY );
371
        }
372
}
373
/*-----------------------------------------------------------*/
374
 
375
static void vCommsRxCoRoutine( xCoRoutineHandle xHandle, unsigned portBASE_TYPE uxIndex )
376
{
377
static char cRxedChar, cExpectedChar = mainFIRST_TX_CHAR;
378
portBASE_TYPE xResult;
379
 
380
        crSTART( xHandle );
381
 
382
        for( ;; )
383
        {
384
                /* Wait for a character to be received. */
385
                crQUEUE_RECEIVE( xHandle, xCommsQueue, ( void * ) &cRxedChar, mainCOMMS_RX_DELAY, &xResult );
386
 
387
                /* Was the character recived (if any) the expected character. */
388
                if( ( cRxedChar != cExpectedChar ) || ( xResult != pdPASS ) )
389
                {
390
                        /* Got an unexpected character.  This can sometimes occur when
391
                        reseting the system using the debugger leaving characters already
392
                        in the UART regsters. */
393
                        uxErrorStatus = pdFAIL;
394
 
395
                        /* Resync by waiting for the end of the current string. */
396
                        while( cRxedChar != mainLAST_TX_CHAR )
397
                        {
398
                                crQUEUE_RECEIVE( xHandle, xCommsQueue, ( void * ) &cRxedChar, mainCOMMS_RX_DELAY, &xResult );
399
                        }
400
 
401
                        /* The next expected character is the start of the string again. */
402
                        cExpectedChar = mainFIRST_TX_CHAR;
403
                }
404
                else
405
                {
406
                        if( cExpectedChar == mainLAST_TX_CHAR )
407
                        {
408
                                /* We have reached the end of the string - we now expect to
409
                                receive the first character in the string again.   The LED is
410
                                toggled to indicate that the entire string was received without
411
                                error. */
412
                                vParTestToggleLED( mainCOMMS_RX_LED );
413
                                cExpectedChar = mainFIRST_TX_CHAR;
414
                        }
415
                        else
416
                        {
417
                                /* We got the expected character, we now expect to receive the
418
                                next character in the string. */
419
                                cExpectedChar++;
420
                        }
421
                }
422
        }
423
 
424
        crEND();
425
}
426
/*-----------------------------------------------------------*/
427
 
428
static void vSerialTxCoRoutine( xCoRoutineHandle xHandle, unsigned portBASE_TYPE uxIndex )
429
{
430
portTickType xDelayPeriod;
431
static unsigned long *pulRandomBytes = mainFIRST_PROGRAM_BYTES;
432
 
433
        /* Co-routine MUST start with a call to crSTART. */
434
        crSTART( xHandle );
435
 
436
        for(;;)
437
    {
438
                /* Was the previously transmitted string received correctly? */
439
                if( uxErrorStatus != pdPASS )
440
                {
441
                        /* An error was encountered so set the error LED. */
442
                        vSetErrorLED();
443
                }
444
 
445
                /* The next character to Tx is the first in the string. */
446
                cNextChar = mainFIRST_TX_CHAR;
447
 
448
                UARTIntDisable( UART0_BASE, UART_INT_TX );
449
                {
450
                        /* Send the first character. */
451
                        if( !( HWREG( UART0_BASE + UART_O_FR ) & UART_FR_TXFF ) )
452
                        {
453
                                HWREG( UART0_BASE + UART_O_DR ) = cNextChar;
454
                        }
455
 
456
                        /* Move the variable to the char to Tx on so the ISR transmits
457
                        the next character in the string once this one has completed. */
458
                        cNextChar++;
459
                }
460
                UARTIntEnable(UART0_BASE, UART_INT_TX);
461
 
462
                /* Toggle the LED to show a new string is being transmitted. */
463
        vParTestToggleLED( mainCOMMS_TX_LED );
464
 
465
                /* Delay before we start the string off again.  A pseudo-random delay
466
                is used as this will provide a better test. */
467
                xDelayPeriod = xTaskGetTickCount() + ( *pulRandomBytes );
468
 
469
                pulRandomBytes++;
470
                if( pulRandomBytes > mainTOTAL_PROGRAM_MEMORY )
471
                {
472
                        pulRandomBytes = mainFIRST_PROGRAM_BYTES;
473
                }
474
 
475
                /* Make sure we don't wait too long... */
476
                xDelayPeriod &= mainMAX_TX_DELAY;
477
 
478
                /* ...but we do want to wait. */
479
                if( xDelayPeriod < mainMIN_TX_DELAY )
480
                {
481
                        xDelayPeriod = mainMIN_TX_DELAY;
482
                }
483
 
484
                /* Block for the random(ish) time. */
485
                crDELAY( xHandle, xDelayPeriod );
486
    }
487
 
488
        /* Co-routine MUST end with a call to crEND. */
489
        crEND();
490
}
491
/*-----------------------------------------------------------*/
492
 
493
static void vSerialInit( void )
494
{
495
        /* Enable the UART.  GPIOA has already been initialised. */
496
        SysCtlPeripheralEnable(SYSCTL_PERIPH_UART0);
497
 
498
        /* Set GPIO A0 and A1 as peripheral function.  They are used to output the
499
        UART signals. */
500
        GPIODirModeSet( GPIO_PORTA_BASE, GPIO_PIN_0 | GPIO_PIN_1, GPIO_DIR_MODE_HW );
501
 
502
        /* Configure the UART for 8-N-1 operation. */
503
        UARTConfigSet( UART0_BASE, mainBAUD_RATE, UART_CONFIG_WLEN_8 | UART_CONFIG_PAR_NONE | UART_CONFIG_STOP_ONE );
504
 
505
        /* We dont want to use the fifo.  This is for test purposes to generate
506
        as many interrupts as possible. */
507
        HWREG( UART0_BASE + UART_O_LCR_H ) &= ~mainFIFO_SET;
508
 
509
        /* Enable both Rx and Tx interrupts. */
510
        HWREG( UART0_BASE + UART_O_IM ) |= ( UART_INT_TX | UART_INT_RX );
511
        IntEnable( INT_UART0 );
512
}
513
/*-----------------------------------------------------------*/
514
 
515
void vUART_ISR(void)
516
{
517
unsigned long ulStatus;
518
char cRxedChar;
519
portBASE_TYPE xTaskWokenByPost = pdFALSE;
520
 
521
        /* What caused the interrupt. */
522
        ulStatus = UARTIntStatus( UART0_BASE, pdTRUE );
523
 
524
        /* Clear the interrupt. */
525
        UARTIntClear( UART0_BASE, ulStatus );
526
 
527
        /* Was an Rx interrpt pending? */
528
        if( ulStatus & UART_INT_RX )
529
        {
530
                if( ( HWREG(UART0_BASE + UART_O_FR ) & UART_FR_RXFF ) )
531
                {
532
                        /* Get the char from the buffer and post it onto the queue of
533
                        Rxed chars.  Posting the character should wake the task that is
534
                        blocked on the queue waiting for characters. */
535
                        cRxedChar = ( char ) HWREG( UART0_BASE + UART_O_DR );
536
                        xTaskWokenByPost = crQUEUE_SEND_FROM_ISR( xCommsQueue, &cRxedChar, xTaskWokenByPost );
537
                }
538
        }
539
 
540
        /* Was a Tx interrupt pending? */
541
        if( ulStatus & UART_INT_TX )
542
        {
543
                /* Send the next character in the string.  We are not using the FIFO. */
544
                if( cNextChar <= mainLAST_TX_CHAR )
545
                {
546
                        if( !( HWREG( UART0_BASE + UART_O_FR ) & UART_FR_TXFF ) )
547
                        {
548
                                HWREG( UART0_BASE + UART_O_DR ) = cNextChar;
549
                        }
550
                        cNextChar++;
551
                }
552
        }
553
 
554
        if( xTaskWokenByPost )
555
        {
556
                /* We are posting to a co-routine rather than a task so don't bother
557
                causing a task switch. */
558
        }
559
}
560
/*-----------------------------------------------------------*/
561
 
562
static void prvPDCWrite( char cAddress, char cData )
563
{
564
        vTaskSuspendAll();
565
        {
566
                PDCWrite( cAddress, cData );
567
        }
568
        xTaskResumeAll();
569
}
570
/*-----------------------------------------------------------*/
571
 
572
void vSetErrorLED( void )
573
{
574
        vParTestSetLED( mainCOMMS_FAIL_LED, pdTRUE );
575
}
576
/*-----------------------------------------------------------*/
577
 
578
void prvSetAndCheckRegisters( void )
579
{
580
        /* Fill the general purpose registers with known values. */
581
        __asm volatile
582
        (
583
        "       mov r11, #10            \n"
584
        "       add r0, r11, #1         \n"
585
        "       add r1, r11, #2         \n"
586
        "       add r2, r11, #3         \n"
587
        "       add r3, r11, #4         \n"
588
        "       add r4, r11, #5         \n"
589
        "       add r5, r11, #6         \n"
590
        "       add r6, r11, #7         \n"
591
        "       add r7, r11, #8         \n"
592
        "       add r8, r11, #9         \n"
593
        "       add r9, r11, #10        \n"
594
        "       add r10, r11, #11       \n"
595
        "       add r12, r11, #12"
596
        );
597
 
598
        /* Check the values are as expected. */
599
        __asm volatile
600
        (
601
        "       cmp r11, #10            \n"
602
        "       bne set_error_led       \n"
603
        "       cmp r0, #11                     \n"
604
        "       bne set_error_led       \n"
605
        "       cmp r1, #12                     \n"
606
        "       bne set_error_led       \n"
607
        "       cmp r2, #13                     \n"
608
        "       bne set_error_led       \n"
609
        "       cmp r3, #14                     \n"
610
        "       bne set_error_led       \n"
611
        "       cmp r4, #15                     \n"
612
        "       bne set_error_led       \n"
613
        "       cmp r5, #16                     \n"
614
        "       bne set_error_led       \n"
615
        "       cmp r6, #17                     \n"
616
        "       bne set_error_led       \n"
617
        "       cmp r7, #18                     \n"
618
        "       bne set_error_led       \n"
619
        "       cmp r8, #19                     \n"
620
        "       bne set_error_led       \n"
621
        "       cmp r9, #20                     \n"
622
        "       bne set_error_led       \n"
623
        "       cmp r10, #21            \n"
624
        "       bne set_error_led       \n"
625
        "       cmp r12, #22            \n"
626
        "       bne set_error_led       \n"
627
        "       bx lr"
628
        );
629
 
630
        __asm volatile
631
        (
632
        "set_error_led:                 \n"
633
        "       push {r14}                      \n"
634
        "       ldr r1, vSetErrorLEDConst\n"
635
        "       blx r1                          \n"
636
        "       pop {r14}                       \n"
637
        "       bx lr                           \n"
638
        "                                               \n"
639
        "       .align 2                        \n"
640
        "vSetErrorLEDConst: .word vSetErrorLED"
641
        );
642
}
643
/*-----------------------------------------------------------*/

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.