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

   1 /*\r
   2         FreeRTOS.org V4.6.1 - Copyright (C) 2003-2007 Richard Barry.\r
   3 \r
   4         This file is part of the FreeRTOS.org distribution.\r
   5 \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
  10 \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
  15 \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
  19 \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
  24         can be applied.\r
  25 \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
  31         Also see http://www.SafeRTOS.com a version that has been certified for use\r
  32         in safety critical systems, plus commercial licensing, development and\r
  33         support options.\r
  34         ***************************************************************************\r
  35 */\r
  36 #include <c8051f120.h>\r
  37 \r
  38 #include "FreeRTOS.h"\r
  39 #include "task.h"\r
  40 #include "partest.h"\r
  41 \r
  42 #define partstPUSH_PULL                 ( ( unsigned portCHAR ) 0xff )\r
  43 #define partstALL_OUTPUTS_OFF   ( ( unsigned portCHAR ) 0xff )\r
  44 \r
  45 /* LED to output is dependent on how the LED's are wired. */\r
  46 #define partstOUTPUT_0                  ( ( unsigned portCHAR ) 0x02 )\r
  47 #define partstOUTPUT_1                  ( ( unsigned portCHAR ) 0x08 )\r
  48 #define partstOUTPUT_2                  ( ( unsigned portCHAR ) 0x20 )\r
  49 #define partstOUTPUT_3                  ( ( unsigned portCHAR ) 0x01 )\r
  50 #define partstOUTPUT_4                  ( ( unsigned portCHAR ) 0x04 )\r
  51 #define partstOUTPUT_5                  ( ( unsigned portCHAR ) 0x10 )\r
  52 #define partstOUTPUT_6                  ( ( unsigned portCHAR ) 0x40 )\r
  53 #define partstOUTPUT_7                  ( ( unsigned portCHAR ) 0x80 )\r
  54 \r
  55 /*-----------------------------------------------------------\r
  56  * Simple parallel port IO routines.\r
  57  *-----------------------------------------------------------*/\r
  58 \r
  59 void vParTestInitialise( void )\r
  60 {\r
  61 unsigned portCHAR ucOriginalSFRPage;\r
  62 \r
  63         /* Remember the SFR page before it is changed so it can get set back\r
  64         before the function exits. */\r
  65         ucOriginalSFRPage = SFRPAGE;\r
  66 \r
  67         /* Setup the SFR page to access the config SFR's. */\r
  68         SFRPAGE = CONFIG_PAGE;\r
  69 \r
  70         /* Set the on board LED to push pull. */\r
  71         P3MDOUT |= partstPUSH_PULL;\r
  72 \r
  73         /* Return the SFR page. */\r
  74         SFRPAGE = ucOriginalSFRPage;\r
  75 \r
  76         P3 = partstALL_OUTPUTS_OFF;\r
  77 }\r
  78 /*-----------------------------------------------------------*/\r
  79 \r
  80 void vParTestSetLED( unsigned portBASE_TYPE uxLED, portBASE_TYPE xValue )\r
  81 {\r
  82 portBASE_TYPE xError = pdFALSE;\r
  83 \r
  84         vTaskSuspendAll();\r
  85         {\r
  86                 if( xValue == pdFALSE )\r
  87                 {\r
  88                         switch( uxLED )\r
  89                         {\r
  90                                 case 0  :       P3 |= partstOUTPUT_0;\r
  91                                                         break;\r
  92                                 case 1  :       P3 |= partstOUTPUT_1;\r
  93                                                         break;\r
  94                                 case 2  :       P3 |= partstOUTPUT_2;\r
  95                                                         break;\r
  96                                 case 3  :       P3 |= partstOUTPUT_3;\r
  97                                                         break;\r
  98                                 case 4  :       P3 |= partstOUTPUT_4;\r
  99                                                         break;\r
 100                                 case 5  :       P3 |= partstOUTPUT_5;\r
 101                                                         break;\r
 102                                 case 6  :       P3 |= partstOUTPUT_6;\r
 103                                                         break;\r
 104                                 case 7  :       P3 |= partstOUTPUT_7;\r
 105                                                         break;\r
 106                                 default :       /* There are no other LED's wired in. */\r
 107                                                         xError = pdTRUE;\r
 108                                                         break;\r
 109                         }\r
 110                 }\r
 111                 else\r
 112                 {\r
 113                         switch( uxLED )\r
 114                         {\r
 115                                 case 0  :       P3 &= ~partstOUTPUT_0;\r
 116                                                         break;\r
 117                                 case 1  :       P3 &= ~partstOUTPUT_1;\r
 118                                                         break;\r
 119                                 case 2  :       P3 &= ~partstOUTPUT_2;\r
 120                                                         break;\r
 121                                 case 3  :       P3 &= ~partstOUTPUT_3;\r
 122                                                         break;\r
 123                                 case 4  :       P3 &= ~partstOUTPUT_4;\r
 124                                                         break;\r
 125                                 case 5  :       P3 &= ~partstOUTPUT_5;\r
 126                                                         break;\r
 127                                 case 6  :       P3 &= ~partstOUTPUT_6;\r
 128                                                         break;\r
 129                                 case 7  :       P3 &= ~partstOUTPUT_7;\r
 130                                                         break;\r
 131                                 default :       /* There are no other LED's wired in. */\r
 132                                                         break;\r
 133                         }\r
 134                 }\r
 135         }\r
 136         xTaskResumeAll();\r
 137 }\r
 138 /*-----------------------------------------------------------*/\r
 139 \r
 140 void vParTestToggleLED( unsigned portBASE_TYPE uxLED )\r
 141 {\r
 142 unsigned portCHAR ucBit;\r
 143 portBASE_TYPE xError = pdFALSE;\r
 144 \r
 145         vTaskSuspendAll();\r
 146         {\r
 147                 switch( uxLED )\r
 148                 {\r
 149                         case 0  :       ucBit = partstOUTPUT_0;\r
 150                                                 break;\r
 151                         case 1  :       ucBit = partstOUTPUT_1;\r
 152                                                 break;\r
 153                         case 2  :       ucBit = partstOUTPUT_2;\r
 154                                                 break;\r
 155                         case 3  :       ucBit = partstOUTPUT_3;\r
 156                                                 break;\r
 157                         case 4  :       ucBit = partstOUTPUT_4;\r
 158                                                 break;\r
 159                         case 5  :       ucBit = partstOUTPUT_5;\r
 160                                                 break;\r
 161                         case 6  :       ucBit = partstOUTPUT_6;\r
 162                                                 break;\r
 163                         case 7  :       ucBit = partstOUTPUT_7;\r
 164                                                 break;\r
 165                         default :       /* There are no other LED's wired in. */\r
 166                                                 xError = pdTRUE;\r
 167                                                 break;\r
 168                 }\r
 169 \r
 170                 if( xError != pdTRUE )\r
 171                 {\r
 172                         if( P3 & ucBit )\r
 173                         {\r
 174                                 P3 &= ~ucBit;\r
 175                         }\r
 176                         else\r
 177                         {\r
 178                                 P3 |= ucBit;\r
 179                         }\r
 180                 }\r
 181         }\r
 182         xTaskResumeAll();\r
 183 }\r
 184 \r
 185 \r