2 FreeRTOS.org V4.0.4 - Copyright (C) 2003-2006 Richard Barry.
\r
4 This file is part of the FreeRTOS.org distribution.
\r
6 FreeRTOS.org is free software; you can redistribute it and/or modify
\r
7 it under the terms of the GNU General Public License as published by
\r
8 the Free Software Foundation; either version 2 of the License, or
\r
9 (at your option) any later version.
\r
11 FreeRTOS.org is distributed in the hope that it will be useful,
\r
12 but WITHOUT ANY WARRANTY; without even the implied warranty of
\r
13 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
\r
14 GNU General Public License for more details.
\r
16 You should have received a copy of the GNU General Public License
\r
17 along with FreeRTOS.org; if not, write to the Free Software
\r
18 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
\r
20 A special exception to the GPL can be applied should you wish to distribute
\r
21 a combined work that includes FreeRTOS.org, without being obliged to provide
\r
22 the source code for any proprietary components. See the licensing section
\r
23 of http://www.FreeRTOS.org for full details of how and when the exception
\r
26 ***************************************************************************
\r
27 See http://www.FreeRTOS.org for documentation, latest information, license
\r
28 and contact details. Please ensure to read the configuration and relevant
\r
29 port sections of the online documentation.
\r
30 ***************************************************************************
\r
33 /* Scheduler includes. */
\r
34 #include "FreeRTOS.h"
\r
35 #include "portable.h"
\r
37 /* Demo app includes. */
\r
38 #include "partest.h"
\r
40 /* Hardware specific definitions. */
\r
41 #include "AT91R40008.h"
\r
45 #define partstNUM_LEDS ( 8 )
\r
46 #define partstALL_OUTPUTS_OFF ( ( unsigned portLONG ) ~(0xFFFFFFFF << partstNUM_LEDS) )
\r
48 static unsigned portLONG ulLEDReg;
\r
50 /*-----------------------------------------------------------
\r
51 * Simple parallel port IO routines.
\r
52 *-----------------------------------------------------------*/
\r
54 static void SetLeds (unsigned int leds)
\r
56 unsigned portLONG ulPIOSetReg, ulPIOClearReg;
\r
58 /* LEDs are grouped in different port bits: P3-P6 and P16-P19.
\r
59 A port bit set to '0' turns an LED on, '1' turns it off. */
\r
61 ulPIOSetReg = ( (leds & 0xF) << 16 ) | ( (leds & 0xF0) >> 1 );
\r
62 ulPIOClearReg = (~ulPIOSetReg) & 0x000F0078;
\r
64 AT91C_BASE_PIO->PIO_SODR = ulPIOSetReg;
\r
65 AT91C_BASE_PIO->PIO_CODR = ulPIOClearReg;
\r
67 /*-----------------------------------------------------------*/
\r
69 void vParTestInitialise( void )
\r
71 /* This is performed from main() as the io bits are shared with other setup
\r
72 functions. Ensure the outputs are off to start. */
\r
73 ulLEDReg = partstALL_OUTPUTS_OFF;
\r
75 /* Enable clock to PIO... */
\r
76 AT91C_BASE_PS->PS_PCER = AT91C_PS_PIO;
\r
78 /* Enable all 8 LEDs and the four switches to be controlled by PIO... */
\r
79 AT91C_BASE_PIO->PIO_PER = P3 | P4 | P5 | P6 | P16 | P17 | P18 | P19 | P1 | P2 | P9 | P12;
\r
81 /* Configure all LED PIO lines for output... */
\r
82 AT91C_BASE_PIO->PIO_OER = P3 | P4 | P5 | P6 | P16 | P17 | P18 | P19;
\r
84 /* Configure all switch PIO lines for input... */
\r
85 AT91C_BASE_PIO->PIO_ODR = P1 | P2 | P9 | P12;
\r
87 /* Set initial state of LEDs. */
\r
88 SetLeds( ulLEDReg );
\r
90 /*-----------------------------------------------------------*/
\r
92 void vParTestSetLED( unsigned portBASE_TYPE uxLED, signed portBASE_TYPE xValue )
\r
94 /* Switch an LED on or off as requested. */
\r
95 if (uxLED < partstNUM_LEDS)
\r
99 ulLEDReg &= ~(1 << uxLED);
\r
103 ulLEDReg |= (1 << uxLED);
\r
106 SetLeds( ulLEDReg );
\r
109 /*-----------------------------------------------------------*/
\r
111 void vParTestToggleLED( unsigned portBASE_TYPE uxLED )
\r
113 /* Toggle the state of the requested LED. */
\r
114 if (uxLED < partstNUM_LEDS)
\r
116 ulLEDReg ^= ( 1 << uxLED );
\r
117 SetLeds( ulLEDReg );
\r