begriffs open source - cmsis-freertos/blob - Demo/Flshlite/ParTest/ParTest.c

   1 /*
   2  * FreeRTOS V202111.00
   3  * Copyright (C) 2020 Amazon.com, Inc. or its affiliates.  All Rights Reserved.
   4  *
   5  * Permission is hereby granted, free of charge, to any person obtaining a copy of
   6  * this software and associated documentation files (the "Software"), to deal in
   7  * the Software without restriction, including without limitation the rights to
   8  * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of
   9  * the Software, and to permit persons to whom the Software is furnished to do so,
  10  * subject to the following conditions:
  11  *
  12  * The above copyright notice and this permission notice shall be included in all
  13  * copies or substantial portions of the Software.
  14  *
  15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS
  17  * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
  18  * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
  19  * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  20  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  21  *
  22  * http://www.FreeRTOS.org
  23  * http://aws.amazon.com/freertos
  24  *
  25  * 1 tab == 4 spaces!
  26  */
  27
  28 /*
  29 Changes from V1.01:
  30
  31         + Types used updated.
  32         + Add vParTestToggleLED();
  33
  34 Changes from V2.0.0
  35
  36         + Use scheduler suspends in place of critical sections.
  37 */
  38
  39
  40 #include "FreeRTOS.h"
  41 #include "task.h"
  42 #include "partest.h"
  43
  44 #define partstALL_OUTPUTS_OFF                   ( ( unsigned short) 0x00 )
  45 #define partstMAX_OUTPUT_LED                    ( ( unsigned char ) 7 )
  46 #define partstPORT_F_ADDR                               ( ( unsigned short ) 0x605 )
  47 #define partstPORT_DIRECTION_REG                ( ( unsigned short ) 0x606 )
  48 #define partstPORT_F_DIR_BIT                    ( ( unsigned short ) 0x20 )
  49
  50 /*lint -e956 File scope parameters okay here. */
  51 static volatile unsigned char ucCurrentOutputValue = partstALL_OUTPUTS_OFF;
  52 /*lint +e956 */
  53
  54 /*-----------------------------------------------------------
  55  * Simple parallel port IO routines.
  56  *-----------------------------------------------------------*/
  57
  58 void vParTestInitialise( void )
  59 {
  60 unsigned short usInput;
  61
  62         ucCurrentOutputValue = partstALL_OUTPUTS_OFF;
  63
  64         /* Set the direction to output for port F. */
  65         usInput = portINPUT_BYTE( partstPORT_DIRECTION_REG );
  66         usInput |= partstPORT_F_DIR_BIT;
  67         portOUTPUT_BYTE( partstPORT_DIRECTION_REG, usInput );
  68
  69         /* Start with all outputs off. */
  70         portOUTPUT_BYTE( partstPORT_F_ADDR, partstALL_OUTPUTS_OFF );
  71 }
  72 /*-----------------------------------------------------------*/
  73
  74 void vParTestSetLED( unsigned portBASE_TYPE uxLED, portBASE_TYPE xValue )
  75 {
  76 unsigned char ucBit = ( unsigned char ) 1;
  77
  78         if( uxLED <= partstMAX_OUTPUT_LED )
  79         {
  80                 ucBit <<= uxLED;
  81         }
  82
  83         vTaskSuspendAll();
  84         {
  85                 if( xValue == pdTRUE )
  86                 {
  87                         ucBit ^= ( unsigned char ) 0xff;
  88                         ucCurrentOutputValue &= ucBit;
  89                 }
  90                 else
  91                 {
  92                         ucCurrentOutputValue |= ucBit;
  93                 }
  94
  95                 portOUTPUT_BYTE( partstPORT_F_ADDR, ( unsigned ) ucCurrentOutputValue );
  96         }
  97         xTaskResumeAll();
  98 }
  99 /*-----------------------------------------------------------*/
 100
 101 void vParTestToggleLED( unsigned portBASE_TYPE uxLED )
 102 {
 103 unsigned char ucBit;
 104
 105         if( uxLED <= partstMAX_OUTPUT_LED )
 106         {
 107                 ucBit = ( ( unsigned char ) 1 ) << uxLED;
 108
 109                 vTaskSuspendAll();
 110                 {
 111                         if( ucCurrentOutputValue & ucBit )
 112                         {
 113                                 ucCurrentOutputValue &= ~ucBit;
 114                         }
 115                         else
 116                         {
 117                                 ucCurrentOutputValue |= ucBit;
 118                         }
 119
 120                         portOUTPUT_BYTE( partstPORT_F_ADDR, ( unsigned ) ucCurrentOutputValue );
 121                 }
 122                 xTaskResumeAll();
 123         }
 124 }
 125