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

   1 /*\r
   2     FreeRTOS V7.4.1 - Copyright (C) 2013 Real Time Engineers Ltd.\r
   3 \r
   4     FEATURES AND PORTS ARE ADDED TO FREERTOS ALL THE TIME.  PLEASE VISIT\r
   5     http://www.FreeRTOS.org TO ENSURE YOU ARE USING THE LATEST VERSION.\r
   6 \r
   7     ***************************************************************************\r
   8      *                                                                       *\r
   9      *    FreeRTOS tutorial books are available in pdf and paperback.        *\r
  10      *    Complete, revised, and edited pdf reference manuals are also       *\r
  11      *    available.                                                         *\r
  12      *                                                                       *\r
  13      *    Purchasing FreeRTOS documentation will not only help you, by       *\r
  14      *    ensuring you get running as quickly as possible and with an        *\r
  15      *    in-depth knowledge of how to use FreeRTOS, it will also help       *\r
  16      *    the FreeRTOS project to continue with its mission of providing     *\r
  17      *    professional grade, cross platform, de facto standard solutions    *\r
  18      *    for microcontrollers - completely free of charge!                  *\r
  19      *                                                                       *\r
  20      *    >>> See http://www.FreeRTOS.org/Documentation for details. <<<     *\r
  21      *                                                                       *\r
  22      *    Thank you for using FreeRTOS, and thank you for your support!      *\r
  23      *                                                                       *\r
  24     ***************************************************************************\r
  25 \r
  26 \r
  27     This file is part of the FreeRTOS distribution.\r
  28 \r
  29     FreeRTOS is free software; you can redistribute it and/or modify it under\r
  30     the terms of the GNU General Public License (version 2) as published by the\r
  31     Free Software Foundation AND MODIFIED BY the FreeRTOS exception.\r
  32 \r
  33     >>>>>>NOTE<<<<<< The modification to the GPL is included to allow you to\r
  34     distribute a combined work that includes FreeRTOS without being obliged to\r
  35     provide the source code for proprietary components outside of the FreeRTOS\r
  36     kernel.\r
  37 \r
  38     FreeRTOS is distributed in the hope that it will be useful, but WITHOUT ANY\r
  39     WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS\r
  40     FOR A PARTICULAR PURPOSE.  See the GNU General Public License for more\r
  41     details. You should have received a copy of the GNU General Public License\r
  42     and the FreeRTOS license exception along with FreeRTOS; if not it can be\r
  43     viewed here: http://www.freertos.org/a00114.html and also obtained by\r
  44     writing to Real Time Engineers Ltd., contact details for whom are available\r
  45     on the FreeRTOS WEB site.\r
  46 \r
  47     1 tab == 4 spaces!\r
  48 \r
  49     ***************************************************************************\r
  50      *                                                                       *\r
  51      *    Having a problem?  Start by reading the FAQ "My application does   *\r
  52      *    not run, what could be wrong?"                                     *\r
  53      *                                                                       *\r
  54      *    http://www.FreeRTOS.org/FAQHelp.html                               *\r
  55      *                                                                       *\r
  56     ***************************************************************************\r
  57 \r
  58 \r
  59     http://www.FreeRTOS.org - Documentation, books, training, latest versions, \r
  60     license and Real Time Engineers Ltd. contact details.\r
  61 \r
  62     http://www.FreeRTOS.org/plus - A selection of FreeRTOS ecosystem products,\r
  63     including FreeRTOS+Trace - an indispensable productivity tool, and our new\r
  64     fully thread aware and reentrant UDP/IP stack.\r
  65 \r
  66     http://www.OpenRTOS.com - Real Time Engineers ltd license FreeRTOS to High \r
  67     Integrity Systems, who sell the code with commercial support, \r
  68     indemnification and middleware, under the OpenRTOS brand.\r
  69     \r
  70     http://www.SafeRTOS.com - High Integrity Systems also provide a safety \r
  71     engineered and independently SIL3 certified version for use in safety and \r
  72     mission critical applications that require provable dependability.\r
  73 */\r
  74 \r
  75 /*-----------------------------------------------------------\r
  76  * Simple parallel port IO routines.\r
  77  *-----------------------------------------------------------*/\r
  78 \r
  79 /* Kernel includes. */\r
  80 #include "FreeRTOS.h"\r
  81 \r
  82 /* Demo application includes. */\r
  83 #include "partest.h"\r
  84 \r
  85 /* Library includes. */\r
  86 #include "xgpio_l.h"\r
  87 \r
  88 /* Misc hardware specific definitions. */\r
  89 #define partstALL_AS_OUTPUT     0x00\r
  90 #define partstCHANNEL_1         0x01\r
  91 #define partstMAX_4BIT_LED      0x03\r
  92 \r
  93 /* The outputs are split into two IO sections, these variables maintain the \r
  94 current value of either section. */\r
  95 static unsigned portBASE_TYPE uxCurrentOutput4Bit, uxCurrentOutput5Bit;\r
  96 \r
  97 /*-----------------------------------------------------------*/\r
  98 /*\r
  99  * Setup the IO for the LED outputs.\r
 100  */\r
 101 void vParTestInitialise( void )\r
 102 {\r
 103         /* Set both sets of LED's on the demo board to outputs. */\r
 104         XGpio_mSetDataDirection( XPAR_LEDS_4BIT_BASEADDR, partstCHANNEL_1, partstALL_AS_OUTPUT );\r
 105         XGpio_mSetDataDirection( XPAR_LEDS_POSITIONS_BASEADDR, partstCHANNEL_1, partstALL_AS_OUTPUT );\r
 106 \r
 107         /* Start with all outputs off. */\r
 108         uxCurrentOutput4Bit = 0;\r
 109         XGpio_mSetDataReg( XPAR_LEDS_4BIT_BASEADDR, partstCHANNEL_1, 0x00 );\r
 110         uxCurrentOutput5Bit = 0;\r
 111         XGpio_mSetDataReg( XPAR_LEDS_POSITIONS_BASEADDR, partstCHANNEL_1, 0x00 );\r
 112 }\r
 113 /*-----------------------------------------------------------*/\r
 114 \r
 115 void vParTestSetLED( unsigned portBASE_TYPE uxLED, signed portBASE_TYPE xValue )\r
 116 {\r
 117 unsigned portBASE_TYPE uxBaseAddress, *puxCurrentValue;\r
 118 \r
 119         portENTER_CRITICAL();\r
 120         {\r
 121                 /* Which IO section does the LED being set/cleared belong to?  The\r
 122                 4 bit or 5 bit outputs? */\r
 123                 if( uxLED <= partstMAX_4BIT_LED )\r
 124                 {\r
 125                         uxBaseAddress = XPAR_LEDS_4BIT_BASEADDR;\r
 126                         puxCurrentValue = &uxCurrentOutput4Bit;\r
 127                 }       \r
 128                 else\r
 129                 {\r
 130                         uxBaseAddress = XPAR_LEDS_POSITIONS_BASEADDR;\r
 131                         puxCurrentValue = &uxCurrentOutput5Bit;\r
 132                         uxLED -= partstMAX_4BIT_LED;\r
 133                 }\r
 134 \r
 135                 /* Setup the bit mask accordingly. */\r
 136                 uxLED = 0x01 << uxLED;\r
 137 \r
 138                 /* Maintain the current output value. */\r
 139                 if( xValue )\r
 140                 {\r
 141                         *puxCurrentValue |= uxLED;\r
 142                 }\r
 143                 else\r
 144                 {\r
 145                         *puxCurrentValue &= ~uxLED;\r
 146                 }\r
 147 \r
 148                 /* Write the value to the port. */\r
 149                 XGpio_mSetDataReg( uxBaseAddress, partstCHANNEL_1, *puxCurrentValue );\r
 150         }\r
 151         portEXIT_CRITICAL();\r
 152 }\r
 153 /*-----------------------------------------------------------*/\r
 154 \r
 155 void vParTestToggleLED( unsigned portBASE_TYPE uxLED )\r
 156 {\r
 157 unsigned portBASE_TYPE uxBaseAddress, *puxCurrentValue;\r
 158 \r
 159         portENTER_CRITICAL();\r
 160         {\r
 161                 /* Which IO section does the LED being toggled belong to?  The\r
 162                 4 bit or 5 bit outputs? */\r
 163                 if( uxLED <= partstMAX_4BIT_LED )\r
 164                 {\r
 165                         uxBaseAddress = XPAR_LEDS_4BIT_BASEADDR;\r
 166                         puxCurrentValue = &uxCurrentOutput4Bit;\r
 167                 }       \r
 168                 else\r
 169                 {\r
 170                         uxBaseAddress = XPAR_LEDS_POSITIONS_BASEADDR;\r
 171                         puxCurrentValue = &uxCurrentOutput5Bit;\r
 172                         uxLED -= partstMAX_4BIT_LED;\r
 173                 }\r
 174 \r
 175                 /* Setup the bit mask accordingly. */\r
 176                 uxLED = 0x01 << uxLED;\r
 177 \r
 178                 /* Maintain the current output value. */\r
 179                 if( *puxCurrentValue & uxLED )\r
 180                 {\r
 181                         *puxCurrentValue &= ~uxLED;\r
 182                 }\r
 183                 else\r
 184                 {\r
 185                         *puxCurrentValue |= uxLED;\r
 186                 }\r
 187 \r
 188                 /* Write the value to the port. */\r
 189                 XGpio_mSetDataReg(uxBaseAddress, partstCHANNEL_1, *puxCurrentValue );\r
 190         }\r
 191         portEXIT_CRITICAL();\r
 192 }\r
 193 \r
 194 \r