git.sur5r.net Git - freertos/blob - FreeRTOS/Demo/CORTEX_A53_64-bit_UltraScale_MPSoC/RTOSDemo_A53_bsp/psu_cortexa53_0/libsrc/standalone_v6_6/src/sleep.c

   1 /******************************************************************************
   2 *
   3 * Copyright (C) 2014 - 2017 Xilinx, Inc. All rights reserved.
   4 *
   5 * Permission is hereby granted, free of charge, to any person obtaining a copy
   6 * of this software and associated documentation files (the "Software"), to deal
   7 * in the Software without restriction, including without limitation the rights
   8 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
   9 * copies of the Software, and to permit persons to whom the Software is
  10 * furnished to do so, subject to the following conditions:
  11 *
  12 * The above copyright notice and this permission notice shall be included in
  13 * all copies or substantial portions of the Software.
  14 *
  15 * Use of the Software is limited solely to applications:
  16 * (a) running on a Xilinx device, or
  17 * (b) that interact with a Xilinx device through a bus or interconnect.
  18 *
  19 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  20 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  21 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  22 * XILINX  BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
  23 * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF
  24 * OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  25 * SOFTWARE.
  26 *
  27 * Except as contained in this notice, the name of the Xilinx shall not be used
  28 * in advertising or otherwise to promote the sale, use or other dealings in
  29 * this Software without prior written authorization from Xilinx.
  30 *
  31 ******************************************************************************/
  32 /*****************************************************************************
  33 *
  34 * @file sleep.c
  35 *
  36 * This function provides a second delay using the Global Timer register in
  37 * the ARM Cortex A53 MP core.
  38 *
  39 * <pre>
  40 * MODIFICATION HISTORY:
  41 *
  42 * Ver   Who      Date     Changes
  43 * ----- -------- -------- -----------------------------------------------
  44 * 5.00  pkp      05/29/14 First release
  45 * 5.04  pkp              28/01/16 Modified the sleep API to configure Time Stamp
  46 *                                                 generator only when disable using frequency from
  47 *                                                 xparamters.h instead of hardcoding
  48 * 5.05  pkp              13/04/16 Modified sleep routine to call XTime_StartTimer
  49 *                                                 which enables timer only when it is disabled and
  50 *                                                 read counter value directly from register instead
  51 *                                                 of calling XTime_GetTime for optimization
  52 * 6.0   asa      08/15/16 Updated the sleep/usleep signature. Fix for CR#956899.
  53 * 6.6   srm      10/18/17 Updated sleep routines to support user configurable
  54 *                         implementation. Now sleep routines will use Timer
  55 *                         specified by the user (i.e. Global timer/TTC timer)
  56 *       srm      01/11/18 Fixed the compilation warning.
  57 * </pre>
  58 *
  59 ******************************************************************************/
  60 /***************************** Include Files *********************************/
  61
  62 #include "sleep.h"
  63 #include "xtime_l.h"
  64 #include "xparameters.h"
  65
  66 #if defined (SLEEP_TIMER_BASEADDR)
  67 #include "xil_sleeptimer.h"
  68 #endif
  69 /****************************  Constant Definitions  ************************/
  70
  71 #if defined (SLEEP_TIMER_BASEADDR)
  72 #define COUNTS_PER_USECOND  (COUNTS_PER_SECOND / 1000000 )
  73 #else
  74 /* Global Timer is always clocked at half of the CPU frequency */
  75 #define COUNTS_PER_USECOND  (COUNTS_PER_SECOND / 1000000 )
  76 #endif
  77
  78 /************************************************************************/
  79 #if !defined (SLEEP_TIMER_BASEADDR)
  80 static void sleep_common(u32 n, u32 count)
  81 {
  82         XTime tEnd, tCur;
  83         /* Start global timer counter, it will only be enabled if it is disabled */
  84         XTime_StartTimer();
  85
  86         tCur = mfcp(CNTPCT_EL0);
  87         tEnd = tCur + (((XTime) n) * count);
  88         do {
  89                 tCur = mfcp(CNTPCT_EL0);
  90         } while (tCur < tEnd);
  91 }
  92 #endif
  93 /*****************************************************************************/
  94 /**
  95 *
  96 * This API gives a delay in microseconds
  97 *
  98 * @param        useconds requested
  99 *
 100 * @return       0 if the delay can be achieved, -1 if the requested delay
 101 *               is out of range
 102 *
 103 * @note         None.
 104 *
 105 ****************************************************************************/
 106 int usleep_A53(unsigned long useconds)
 107 {
 108 #if defined (SLEEP_TIMER_BASEADDR)
 109         Xil_SleepTTCCommon(useconds, COUNTS_PER_USECOND);
 110 #else
 111         sleep_common((u32)useconds, COUNTS_PER_USECOND);
 112 #endif
 113
 114         return 0;
 115 }
 116
 117 /*****************************************************************************/
 118 /*
 119 *
 120 * This API is used to provide delays in seconds
 121 *
 122 * @param        seconds requested
 123 *
 124 * @return       0 always
 125 *
 126 * @note         None.
 127 *
 128 ****************************************************************************/
 129 unsigned sleep_A53(unsigned int seconds)
 130 {
 131 #if defined (SLEEP_TIMER_BASEADDR)
 132         Xil_SleepTTCCommon(seconds, COUNTS_PER_SECOND);
 133 #else
 134         sleep_common(seconds, COUNTS_PER_SECOND);
 135 #endif
 136
 137         return 0;
 138 }