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

Subversion Repositories openrisc

[/] [openrisc/] [trunk/] [rtos/] [freertos-6.1.1/] [Demo/] [CORTEX_LM3S102_Rowley/] [Demo1/] [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 six co-routines and two tasks (three 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 and final task control the transmission and reception
67
 * of a string to UART 0.  The co-routine periodically sends the first
68
 * character of the string to the UART, with the UART's TxEnd interrupt being
69
 * used to transmit the remaining characters.  The UART's RxEnd interrupt
70
 * receives the characters and places them on a queue to be processed by the
71
 * 'COMs Rx' task.  An error is latched should an unexpected character be
72
 * received, or any 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
/* Only one co-routine is created so its index is not important. */
127
#define mainTX_CO_ROUTINE_INDEX         ( 0 )
128
 
129
/* The time between transmissions of the string on UART 0.   This is pseudo
130
random in order to generate a bit or randomness to when the interrupts occur.*/
131
#define mainMIN_TX_DELAY                        ( 40 / portTICK_RATE_MS )
132
#define mainMAX_TX_DELAY                        ( ( portTickType ) 0x7f )
133
#define mainOFFSET_TIME                         ( ( portTickType ) 3 )
134
 
135
/* The time the Comms Rx task should wait to receive a character.  This should
136
be slightly longer than the time between transmissions.  If we do not receive
137
a character after this time then there must be an error in the transmission or
138
the timing of the transmission. */
139
#define mainCOMMS_RX_DELAY                      ( mainMAX_TX_DELAY + 20 )
140
 
141
/* The task priorites. */
142
#define mainLCD_TASK_PRIORITY           ( tskIDLE_PRIORITY )
143
#define mainCOMMS_RX_TASK_PRIORITY      ( tskIDLE_PRIORITY + 1 )
144
 
145
/* The LED's toggled by the various tasks. */
146
#define mainCOMMS_FAIL_LED                      ( 7 )
147
#define mainCOMMS_RX_LED                        ( 6 )
148
#define mainCOMMS_TX_LED                        ( 5 )
149
 
150
/* The baud rate used by the UART comms tasks/co-routine. */
151
#define mainBAUD_RATE                           ( 57600 )
152
 
153
/* FIFO setting for the UART.  The FIFO is not used to create a better test. */
154
#define mainFIFO_SET                            ( 0x10 )
155
 
156
/* The string that is transmitted on the UART contains sequentially the
157
characters from mainFIRST_TX_CHAR to mainLAST_TX_CHAR. */
158
#define mainFIRST_TX_CHAR '0'
159
#define mainLAST_TX_CHAR 'z'
160
 
161
/* Just used to walk through the program memory in order that some random data
162
can be generated. */
163
#define mainTOTAL_PROGRAM_MEMORY ( ( unsigned long * ) ( 8 * 1024 ) )
164
#define mainFIRST_PROGRAM_BYTES ( ( unsigned long * ) 4 )
165
 
166
/* The error routine that is called if the driver library encounters an error. */
167
#ifdef DEBUG
168
void
169
__error__(char *pcFilename, unsigned long ulLine)
170
{
171
}
172
#endif
173
 
174
/*-----------------------------------------------------------*/
175
 
176
/*
177
 * The task that rotates text on the LCD.
178
 */
179
static void vLCDTask( void * pvParameters );
180
 
181
/*
182
 * The task that receives the characters from UART 0.
183
 */
184
static void vCommsRxTask( void * pvParameters );
185
 
186
/*
187
 * The co-routine that periodically initiates the transmission of the string on
188
 * the UART.
189
 */
190
static void vSerialTxCoRoutine( xCoRoutineHandle xHandle, unsigned portBASE_TYPE uxIndex );
191
 
192
/*
193
 * Writes a string the the LCD.
194
 */
195
static void prvWriteString( const char *pcString );
196
 
197
/*
198
 * Initialisation routine for the UART.
199
 */
200
static void vSerialInit( void );
201
 
202
/*
203
 * Thread safe write to the PDC.
204
 */
205
static void prvPDCWrite( char cAddress, char cData );
206
 
207
/*
208
 * Function to simply set a known value into the general purpose registers
209
 * then read them back to ensure they remain set correctly.  An incorrect value
210
 * being indicative of an error in the task switching mechanism.
211
 */
212
void prvSetAndCheckRegisters( void );
213
 
214
/*
215
 * Latch the LED that indicates that an error has occurred.
216
 */
217
void vSetErrorLED( void );
218
 
219
/*
220
 * Sets up the PLL and ports used by the demo.
221
 */
222
static void prvSetupHardware( void );
223
 
224
/*-----------------------------------------------------------*/
225
 
226
/* Error flag set to pdFAIL if an error is encountered in the tasks/co-routines
227
defined within this file. */
228
unsigned portBASE_TYPE uxErrorStatus = pdPASS;
229
 
230
/* The next character to transmit. */
231
static char cNextChar;
232
 
233
/* The queue used to transmit characters from the interrupt to the Comms Rx
234
task. */
235
static xQueueHandle xCommsQueue;
236
 
237
/*-----------------------------------------------------------*/
238
 
239
int main( void )
240
{
241
        /* Create the queue used to communicate between the UART ISR and the Comms
242
        Rx task. */
243
        xCommsQueue = xQueueCreate( mainRX_QUEUE_LEN, sizeof( char ) );
244
 
245
        /* Setup the ports used by the demo and the clock. */
246
        prvSetupHardware();
247
 
248
        /* Create the co-routines that flash the LED's. */
249
        vStartFlashCoRoutines( mainNUM_FLASH_CO_ROUTINES );
250
 
251
        /* Create the co-routine that initiates the transmission of characters
252
        on the UART. */
253
        xCoRoutineCreate( vSerialTxCoRoutine, mainTX_CO_ROUTINE_PRIORITY, mainTX_CO_ROUTINE_INDEX );
254
 
255
        /* Create the LCD and Comms Rx tasks. */
256
        xTaskCreate( vLCDTask, "LCD", configMINIMAL_STACK_SIZE, NULL, mainLCD_TASK_PRIORITY, NULL );
257
        xTaskCreate( vCommsRxTask, "CMS", configMINIMAL_STACK_SIZE, NULL, mainCOMMS_RX_TASK_PRIORITY, NULL );
258
 
259
        /* Start the scheduler running the tasks and co-routines just created. */
260
        vTaskStartScheduler();
261
 
262
        /* Should not get here unless we did not have enough memory to start the
263
        scheduler. */
264
        for( ;; );
265
        return 0;
266
}
267
/*-----------------------------------------------------------*/
268
 
269
static void prvSetupHardware( void )
270
{
271
        /* Setup the PLL. */
272
        SysCtlClockSet( SYSCTL_SYSDIV_10 | SYSCTL_USE_PLL | SYSCTL_OSC_MAIN | SYSCTL_XTAL_6MHZ );
273
 
274
        /* Initialise the hardware used to talk to the LCD, LED's and UART. */
275
        PDCInit();
276
        vParTestInitialise();
277
        vSerialInit();
278
}
279
/*-----------------------------------------------------------*/
280
 
281
void vApplicationIdleHook( void )
282
{
283
        /* The co-routines are executed in the idle task using the idle task
284
        hook. */
285
        for( ;; )
286
        {
287
                /* Schedule the co-routines. */
288
                vCoRoutineSchedule();
289
 
290
                /* Run the register check function between each co-routine. */
291
                prvSetAndCheckRegisters();
292
        }
293
}
294
/*-----------------------------------------------------------*/
295
 
296
static void prvWriteString( const char *pcString )
297
{
298
        /* Write pcString to the LED, pausing between each character. */
299
        prvPDCWrite(PDC_LCD_CSR, LCD_CLEAR);
300
        while( *pcString )
301
        {
302
                vTaskDelay( mainCHAR_WRITE_DELAY );
303
                prvPDCWrite( PDC_LCD_RAM, *pcString );
304
                pcString++;
305
        }
306
}
307
/*-----------------------------------------------------------*/
308
 
309
void vLCDTask( void * pvParameters )
310
{
311
unsigned portBASE_TYPE uxIndex;
312
const unsigned char ucCFGData[] = {
313
                                                                                        0x30,   /* Set data bus to 8-bits. */
314
                                                                                        0x30,
315
                                                                                        0x30,
316
                                                                                        0x3C,   /* Number of lines/font. */
317
                                                                                        0x08,   /* Display off. */
318
                                                                                        0x01,   /* Display clear. */
319
                                                                                        0x06,   /* Entry mode [cursor dir][shift]. */
320
                                                                                        0x0C    /* Display on [display on][curson on][blinking on]. */
321
                                                                          };
322
 
323
/* The strings that are written to the LCD. */
324
const char *pcStringsToDisplay[] = {
325
                                                                                        "Stellaris",
326
                                                                                        "Demo",
327
                                                                                        "One",
328
                                                                                        "www.FreeRTOS.org",
329
                                                                                        ""
330
                                                                           };
331
 
332
        /* Configure the LCD. */
333
        uxIndex = 0;
334
        while( uxIndex < sizeof( ucCFGData ) )
335
        {
336
                prvPDCWrite( PDC_LCD_CSR, ucCFGData[ uxIndex ] );
337
                uxIndex++;
338
                vTaskDelay( mainCHAR_WRITE_DELAY );
339
        }
340
 
341
        /* Turn the LCD Backlight on. */
342
        prvPDCWrite( PDC_CSR, 0x01 );
343
 
344
        /* Clear display. */
345
        vTaskDelay( mainCHAR_WRITE_DELAY );
346
        prvPDCWrite( PDC_LCD_CSR, LCD_CLEAR );
347
 
348
        uxIndex = 0;
349
        for( ;; )
350
        {
351
                /* Display the string on the LCD. */
352
                prvWriteString( pcStringsToDisplay[ uxIndex ] );
353
 
354
                /* Move on to the next string - wrapping if necessary. */
355
                uxIndex++;
356
                if( *( pcStringsToDisplay[ uxIndex ] ) == 0x00 )
357
                {
358
                        uxIndex = 0;
359
                        /* Longer pause on the last string to be sent. */
360
                        vTaskDelay( mainSTRING_WRITE_DELAY * 2 );
361
                }
362
 
363
                /* Wait until it is time to move onto the next string. */
364
                vTaskDelay( mainSTRING_WRITE_DELAY );
365
        }
366
}
367
/*-----------------------------------------------------------*/
368
 
369
static void vCommsRxTask( void * pvParameters )
370
{
371
static char cRxedChar, cExpectedChar;
372
 
373
        /* Set the char we expect to receive to the start of the string. */
374
        cExpectedChar = mainFIRST_TX_CHAR;
375
 
376
        for( ;; )
377
        {
378
                /* Wait for a character to be received. */
379
                xQueueReceive( xCommsQueue, ( void * ) &cRxedChar, mainCOMMS_RX_DELAY );
380
 
381
                /* Was the character recived (if any) the expected character. */
382
                if( cRxedChar != cExpectedChar )
383
                {
384
                        /* Got an unexpected character.  This can sometimes occur when
385
                        reseting the system using the debugger leaving characters already
386
                        in the UART regsters. */
387
                        uxErrorStatus = pdFAIL;
388
 
389
                        /* Resync by waiting for the end of the current string. */
390
                        while( cRxedChar != mainLAST_TX_CHAR )
391
                        {
392
                                while( !xQueueReceive( xCommsQueue, ( void * ) &cRxedChar, portMAX_DELAY ) );
393
                        }
394
 
395
                        /* The next expected character is the start of the string again. */
396
                        cExpectedChar = mainFIRST_TX_CHAR;
397
                }
398
                else
399
                {
400
                        if( cExpectedChar == mainLAST_TX_CHAR )
401
                        {
402
                                /* We have reached the end of the string - we now expect to
403
                                receive the first character in the string again.   The LED is
404
                                toggled to indicate that the entire string was received without
405
                                error. */
406
                                vParTestToggleLED( mainCOMMS_RX_LED );
407
                                cExpectedChar = mainFIRST_TX_CHAR;
408
                        }
409
                        else
410
                        {
411
                                /* We got the expected character, we now expect to receive the
412
                                next character in the string. */
413
                                cExpectedChar++;
414
                        }
415
                }
416
        }
417
}
418
/*-----------------------------------------------------------*/
419
 
420
static void vSerialTxCoRoutine( xCoRoutineHandle xHandle, unsigned portBASE_TYPE uxIndex )
421
{
422
portTickType xDelayPeriod;
423
static unsigned long *pulRandomBytes = mainFIRST_PROGRAM_BYTES;
424
 
425
        /* Co-routine MUST start with a call to crSTART. */
426
        crSTART( xHandle );
427
 
428
        for(;;)
429
    {
430
                /* Was the previously transmitted string received correctly? */
431
                if( uxErrorStatus != pdPASS )
432
                {
433
                        /* An error was encountered so set the error LED. */
434
                        vSetErrorLED();
435
                }
436
 
437
                /* The next character to Tx is the first in the string. */
438
                cNextChar = mainFIRST_TX_CHAR;
439
 
440
                UARTIntDisable( UART0_BASE, UART_INT_TX );
441
                {
442
                        /* Send the first character. */
443
                        if( !( HWREG( UART0_BASE + UART_O_FR ) & UART_FR_TXFF ) )
444
                        {
445
                                HWREG( UART0_BASE + UART_O_DR ) = cNextChar;
446
                        }
447
 
448
                        /* Move the variable to the char to Tx on so the ISR transmits
449
                        the next character in the string once this one has completed. */
450
                        cNextChar++;
451
                }
452
                UARTIntEnable(UART0_BASE, UART_INT_TX);
453
 
454
                /* Toggle the LED to show a new string is being transmitted. */
455
        vParTestToggleLED( mainCOMMS_TX_LED );
456
 
457
                /* Delay before we start the string off again.  A pseudo-random delay
458
                is used as this will provide a better test. */
459
                xDelayPeriod = xTaskGetTickCount() + ( *pulRandomBytes );
460
 
461
                pulRandomBytes++;
462
                if( pulRandomBytes > mainTOTAL_PROGRAM_MEMORY )
463
                {
464
                        pulRandomBytes = mainFIRST_PROGRAM_BYTES;
465
                }
466
 
467
                /* Make sure we don't wait too long... */
468
                xDelayPeriod &= mainMAX_TX_DELAY;
469
 
470
                /* ...but we do want to wait. */
471
                if( xDelayPeriod < mainMIN_TX_DELAY )
472
                {
473
                        xDelayPeriod = mainMIN_TX_DELAY;
474
                }
475
 
476
                /* Block for the random(ish) time. */
477
                crDELAY( xHandle, xDelayPeriod );
478
    }
479
 
480
        /* Co-routine MUST end with a call to crEND. */
481
        crEND();
482
}
483
/*-----------------------------------------------------------*/
484
 
485
static void vSerialInit( void )
486
{
487
        /* Enable the UART.  GPIOA has already been initialised. */
488
        SysCtlPeripheralEnable(SYSCTL_PERIPH_UART0);
489
 
490
        /* Set GPIO A0 and A1 as peripheral function.  They are used to output the
491
        UART signals. */
492
        GPIODirModeSet( GPIO_PORTA_BASE, GPIO_PIN_0 | GPIO_PIN_1, GPIO_DIR_MODE_HW );
493
 
494
        /* Configure the UART for 8-N-1 operation. */
495
        UARTConfigSet( UART0_BASE, mainBAUD_RATE, UART_CONFIG_WLEN_8 | UART_CONFIG_PAR_NONE | UART_CONFIG_STOP_ONE );
496
 
497
        /* We dont want to use the fifo.  This is for test purposes to generate
498
        as many interrupts as possible. */
499
        HWREG( UART0_BASE + UART_O_LCR_H ) &= ~mainFIFO_SET;
500
 
501
        /* Enable both Rx and Tx interrupts. */
502
        HWREG( UART0_BASE + UART_O_IM ) |= ( UART_INT_TX | UART_INT_RX );
503
        IntEnable( INT_UART0 );
504
}
505
/*-----------------------------------------------------------*/
506
 
507
void vUART_ISR(void)
508
{
509
unsigned long ulStatus;
510
char cRxedChar;
511
portBASE_TYPE xHigherPriorityTaskWoken = pdFALSE;
512
 
513
        /* What caused the interrupt. */
514
        ulStatus = UARTIntStatus( UART0_BASE, pdTRUE );
515
 
516
        /* Clear the interrupt. */
517
        UARTIntClear( UART0_BASE, ulStatus );
518
 
519
        /* Was an Rx interrpt pending? */
520
        if( ulStatus & UART_INT_RX )
521
        {
522
                if( ( HWREG(UART0_BASE + UART_O_FR ) & UART_FR_RXFF ) )
523
                {
524
                        /* Get the char from the buffer and post it onto the queue of
525
                        Rxed chars.  Posting the character should wake the task that is
526
                        blocked on the queue waiting for characters. */
527
                        cRxedChar = ( char ) HWREG( UART0_BASE + UART_O_DR );
528
                        xQueueSendFromISR( xCommsQueue, &cRxedChar, &xHigherPriorityTaskWoken );
529
                }
530
        }
531
 
532
        /* Was a Tx interrupt pending? */
533
        if( ulStatus & UART_INT_TX )
534
        {
535
                /* Send the next character in the string.  We are not using the FIFO. */
536
                if( cNextChar <= mainLAST_TX_CHAR )
537
                {
538
                        if( !( HWREG( UART0_BASE + UART_O_FR ) & UART_FR_TXFF ) )
539
                        {
540
                                HWREG( UART0_BASE + UART_O_DR ) = cNextChar;
541
                        }
542
                        cNextChar++;
543
                }
544
        }
545
 
546
        /* If a task was woken by the character being received then we force
547
        a context switch to occur in case the task is of higher priority than
548
        the currently executing task (i.e. the task that this interrupt
549
        interrupted.) */
550
        portEND_SWITCHING_ISR( xHigherPriorityTaskWoken );
551
}
552
/*-----------------------------------------------------------*/
553
 
554
static void prvPDCWrite( char cAddress, char cData )
555
{
556
        vTaskSuspendAll();
557
        {
558
                PDCWrite( cAddress, cData );
559
        }
560
        xTaskResumeAll();
561
}
562
/*-----------------------------------------------------------*/
563
 
564
void vSetErrorLED( void )
565
{
566
        vParTestSetLED( mainCOMMS_FAIL_LED, pdTRUE );
567
}
568
/*-----------------------------------------------------------*/
569
 
570
void prvSetAndCheckRegisters( void )
571
{
572
        /* Fill the general purpose registers with known values. */
573
        __asm volatile
574
        (
575
        "       mov r11, #10            \n"
576
        "       add r0, r11, #1         \n"
577
        "       add r1, r11, #2         \n"
578
        "       add r2, r11, #3         \n"
579
        "       add r3, r11, #4         \n"
580
        "       add r4, r11, #5         \n"
581
        "       add r5, r11, #6         \n"
582
        "       add r6, r11, #7         \n"
583
        "       add r7, r11, #8         \n"
584
        "       add r8, r11, #9         \n"
585
        "       add r9, r11, #10        \n"
586
        "       add r10, r11, #11       \n"
587
        "       add r12, r11, #12"
588
        );
589
 
590
        /* Check the values are as expected. */
591
        __asm volatile
592
        (
593
        "       cmp r11, #10            \n"
594
        "       bne set_error_led       \n"
595
        "       cmp r0, #11                     \n"
596
        "       bne set_error_led       \n"
597
        "       cmp r1, #12                     \n"
598
        "       bne set_error_led       \n"
599
        "       cmp r2, #13                     \n"
600
        "       bne set_error_led       \n"
601
        "       cmp r3, #14                     \n"
602
        "       bne set_error_led       \n"
603
        "       cmp r4, #15                     \n"
604
        "       bne set_error_led       \n"
605
        "       cmp r5, #16                     \n"
606
        "       bne set_error_led       \n"
607
        "       cmp r6, #17                     \n"
608
        "       bne set_error_led       \n"
609
        "       cmp r7, #18                     \n"
610
        "       bne set_error_led       \n"
611
        "       cmp r8, #19                     \n"
612
        "       bne set_error_led       \n"
613
        "       cmp r9, #20                     \n"
614
        "       bne set_error_led       \n"
615
        "       cmp r10, #21            \n"
616
        "       bne set_error_led       \n"
617
        "       cmp r12, #22            \n"
618
        "       bne set_error_led       \n"
619
        "       bx lr"
620
        );
621
 
622
        __asm volatile
623
        (
624
        "set_error_led:                 \n"
625
        "       push {r14}                      \n"
626
        "       ldr r1, vSetErrorLEDConst\n"
627
        "       blx r1                          \n"
628
        "       pop {r14}                       \n"
629
        "       bx lr                           \n"
630
        "                                               \n"
631
        "       .align 2                        \n"
632
        "vSetErrorLEDConst: .word vSetErrorLED"
633
        );
634
}
635
/*-----------------------------------------------------------*/

powered by: WebSVN 2.1.0

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