git.sur5r.net Git - freertos/blob - FreeRTOS/Demo/ARM7_AT91FR40008_GCC/ParTest/ParTest.c

   1 /*\r
   2  * FreeRTOS Kernel V10.0.0\r
   3  * Copyright (C) 2017 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. If you wish to use our Amazon\r
  14  * FreeRTOS name, please do so in a fair use way that does not cause confusion.\r
  15  *\r
  16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR\r
  17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS\r
  18  * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR\r
  19  * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER\r
  20  * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN\r
  21  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.\r
  22  *\r
  23  * http://www.FreeRTOS.org\r
  24  * http://aws.amazon.com/freertos\r
  25  *\r
  26  * 1 tab == 4 spaces!\r
  27  */\r
  28 \r
  29 /* Scheduler includes. */\r
  30 #include "FreeRTOS.h"\r
  31 #include "portable.h"\r
  32 \r
  33 /* Demo app includes. */\r
  34 #include "partest.h"\r
  35 \r
  36 /* Hardware specific definitions. */\r
  37 #include "AT91R40008.h"\r
  38 #include "pio.h"\r
  39 #include "aic.h"\r
  40 \r
  41 #define partstNUM_LEDS                  ( 8 )\r
  42 #define partstALL_OUTPUTS_OFF   ( ( unsigned long ) ~(0xFFFFFFFF << partstNUM_LEDS) )\r
  43 \r
  44 static unsigned long ulLEDReg;\r
  45 \r
  46 /*-----------------------------------------------------------\r
  47  * Simple parallel port IO routines.\r
  48  *-----------------------------------------------------------*/\r
  49 \r
  50 static void SetLeds (unsigned int leds)\r
  51 {\r
  52 unsigned long ulPIOSetReg, ulPIOClearReg;\r
  53 \r
  54         /* LEDs are grouped in different port bits: P3-P6 and P16-P19.\r
  55         A port bit set to '0' turns an LED on, '1' turns it off. */\r
  56 \r
  57         ulPIOSetReg = ( (leds & 0xF) << 16 ) | ( (leds & 0xF0) >> 1 );\r
  58         ulPIOClearReg = (~ulPIOSetReg) & 0x000F0078;\r
  59 \r
  60         AT91C_BASE_PIO->PIO_SODR = ulPIOSetReg;\r
  61         AT91C_BASE_PIO->PIO_CODR = ulPIOClearReg;\r
  62 }\r
  63 /*-----------------------------------------------------------*/\r
  64 \r
  65 void vParTestInitialise( void )\r
  66 {\r
  67         /* This is performed from main() as the io bits are shared with other setup\r
  68         functions.  Ensure the outputs are off to start. */\r
  69         ulLEDReg = partstALL_OUTPUTS_OFF;  \r
  70 \r
  71         /* Enable clock to PIO... */\r
  72         AT91C_BASE_PS->PS_PCER = AT91C_PS_PIO;\r
  73 \r
  74         /* Enable all 8 LEDs and the four switches to be controlled by PIO... */\r
  75         AT91C_BASE_PIO->PIO_PER = P3 | P4 | P5 | P6 | P16 | P17 | P18 | P19 | P1 | P2 | P9 | P12;\r
  76 \r
  77         /* Configure all LED PIO lines for output... */\r
  78         AT91C_BASE_PIO->PIO_OER = P3 | P4 | P5 | P6 | P16 | P17 | P18 | P19;\r
  79 \r
  80         /* Configure all switch PIO lines for input... */\r
  81         AT91C_BASE_PIO->PIO_ODR = P1 | P2 | P9 | P12;\r
  82 \r
  83         /* Set initial state of LEDs. */\r
  84         SetLeds( ulLEDReg );\r
  85 }\r
  86 /*-----------------------------------------------------------*/\r
  87 \r
  88 void vParTestSetLED( unsigned portBASE_TYPE uxLED, signed portBASE_TYPE xValue )\r
  89 {\r
  90         /* Switch an LED on or off as requested. */\r
  91         if (uxLED < partstNUM_LEDS)\r
  92         {\r
  93                 if( xValue )\r
  94                 {\r
  95                         ulLEDReg &= ~(1 << uxLED);\r
  96                 }\r
  97                 else\r
  98                 {\r
  99                         ulLEDReg |= (1 << uxLED);\r
 100                 }\r
 101 \r
 102                 SetLeds( ulLEDReg );\r
 103         }\r
 104 }\r
 105 /*-----------------------------------------------------------*/\r
 106 \r
 107 void vParTestToggleLED( unsigned portBASE_TYPE uxLED )\r
 108 {\r
 109         /* Toggle the state of the requested LED. */\r
 110         if (uxLED < partstNUM_LEDS)\r
 111         {\r
 112                 ulLEDReg ^= ( 1 << uxLED );\r
 113                 SetLeds( ulLEDReg );\r
 114         }\r
 115 }\r
 116 \r