You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
125 lines
4.0 KiB
C
125 lines
4.0 KiB
C
/*
|
|
FreeRTOS.org V4.7.0 - Copyright (C) 2003-2007 Richard Barry.
|
|
|
|
This file is part of the FreeRTOS.org distribution.
|
|
|
|
FreeRTOS.org is free software; you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation; either version 2 of the License, or
|
|
(at your option) any later version.
|
|
|
|
FreeRTOS.org is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with FreeRTOS.org; if not, write to the Free Software
|
|
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
|
|
A special exception to the GPL can be applied should you wish to distribute
|
|
a combined work that includes FreeRTOS.org, without being obliged to provide
|
|
the source code for any proprietary components. See the licensing section
|
|
of http://www.FreeRTOS.org for full details of how and when the exception
|
|
can be applied.
|
|
|
|
***************************************************************************
|
|
See http://www.FreeRTOS.org for documentation, latest information, license
|
|
and contact details. Please ensure to read the configuration and relevant
|
|
port sections of the online documentation.
|
|
|
|
Also see http://www.SafeRTOS.com a version that has been certified for use
|
|
in safety critical systems, plus commercial licensing, development and
|
|
support options.
|
|
***************************************************************************
|
|
*/
|
|
|
|
/* Scheduler includes. */
|
|
#include "FreeRTOS.h"
|
|
#include "portable.h"
|
|
|
|
/* Demo app includes. */
|
|
#include "partest.h"
|
|
|
|
/* Hardware specific definitions. */
|
|
#include "AT91R40008.h"
|
|
#include "pio.h"
|
|
#include "aic.h"
|
|
|
|
#define partstNUM_LEDS ( 8 )
|
|
#define partstALL_OUTPUTS_OFF ( ( unsigned portLONG ) ~(0xFFFFFFFF << partstNUM_LEDS) )
|
|
|
|
static unsigned portLONG ulLEDReg;
|
|
|
|
/*-----------------------------------------------------------
|
|
* Simple parallel port IO routines.
|
|
*-----------------------------------------------------------*/
|
|
|
|
static void SetLeds (unsigned int leds)
|
|
{
|
|
unsigned portLONG ulPIOSetReg, ulPIOClearReg;
|
|
|
|
/* LEDs are grouped in different port bits: P3-P6 and P16-P19.
|
|
A port bit set to '0' turns an LED on, '1' turns it off. */
|
|
|
|
ulPIOSetReg = ( (leds & 0xF) << 16 ) | ( (leds & 0xF0) >> 1 );
|
|
ulPIOClearReg = (~ulPIOSetReg) & 0x000F0078;
|
|
|
|
AT91C_BASE_PIO->PIO_SODR = ulPIOSetReg;
|
|
AT91C_BASE_PIO->PIO_CODR = ulPIOClearReg;
|
|
}
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vParTestInitialise( void )
|
|
{
|
|
/* This is performed from main() as the io bits are shared with other setup
|
|
functions. Ensure the outputs are off to start. */
|
|
ulLEDReg = partstALL_OUTPUTS_OFF;
|
|
|
|
/* Enable clock to PIO... */
|
|
AT91C_BASE_PS->PS_PCER = AT91C_PS_PIO;
|
|
|
|
/* Enable all 8 LEDs and the four switches to be controlled by PIO... */
|
|
AT91C_BASE_PIO->PIO_PER = P3 | P4 | P5 | P6 | P16 | P17 | P18 | P19 | P1 | P2 | P9 | P12;
|
|
|
|
/* Configure all LED PIO lines for output... */
|
|
AT91C_BASE_PIO->PIO_OER = P3 | P4 | P5 | P6 | P16 | P17 | P18 | P19;
|
|
|
|
/* Configure all switch PIO lines for input... */
|
|
AT91C_BASE_PIO->PIO_ODR = P1 | P2 | P9 | P12;
|
|
|
|
/* Set initial state of LEDs. */
|
|
SetLeds( ulLEDReg );
|
|
}
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vParTestSetLED( unsigned portBASE_TYPE uxLED, signed portBASE_TYPE xValue )
|
|
{
|
|
/* Switch an LED on or off as requested. */
|
|
if (uxLED < partstNUM_LEDS)
|
|
{
|
|
if( xValue )
|
|
{
|
|
ulLEDReg &= ~(1 << uxLED);
|
|
}
|
|
else
|
|
{
|
|
ulLEDReg |= (1 << uxLED);
|
|
}
|
|
|
|
SetLeds( ulLEDReg );
|
|
}
|
|
}
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vParTestToggleLED( unsigned portBASE_TYPE uxLED )
|
|
{
|
|
/* Toggle the state of the requested LED. */
|
|
if (uxLED < partstNUM_LEDS)
|
|
{
|
|
ulLEDReg ^= ( 1 << uxLED );
|
|
SetLeds( ulLEDReg );
|
|
}
|
|
}
|
|
|