git.sur5r.net Git - freertos/blob - FreeRTOS/Demo/CORTEX_A9_Zynq_ZC702/RTOSDemo_bsp/ps7_cortexa9_0/libsrc/standalone_v6_6/src/usleep.c

   1 /******************************************************************************
   2 *
   3 * Copyright (C) 2009 - 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 *
  35 * @file usleep.c
  36 *
  37 * This function provides a microsecond delay using the Global Timer register in
  38 * the ARM Cortex A9 MP core.
  39 *
  40 * <pre>
  41 * MODIFICATION HISTORY:
  42 *
  43 * Ver   Who      Date     Changes
  44 * ----- -------- -------- -----------------------------------------------
  45 * 1.00a ecm/sdm  11/11/09 First release
  46 * 3.07a sgd      07/05/12 Upadted micro sleep function to make use Global Timer
  47 * 4.2   pkp              08/04/14 Removed unimplemented nanosleep routine as it is not
  48 *                                                 possible to generate timer in nanosecond due to
  49 *                                                 limited cpu frequency
  50 * 6.0   asa      08/15/16 Updated the usleep signature. Fix for CR#956899.
  51 * 6.6   srm      10/18/17 Updated sleep routines to support user configurable
  52 *                         implementation. Now sleep routines will use Timer
  53 *                         specified by the user (i.e. Global timer/TTC timer)
  54 * </pre>
  55 *
  56 ******************************************************************************/
  57 /***************************** Include Files *********************************/
  58
  59 #include "sleep.h"
  60 #include "xtime_l.h"
  61 #include "xparameters.h"
  62 #include "xil_types.h"
  63 #include "xpseudo_asm.h"
  64 #include "xreg_cortexa9.h"
  65
  66 #if defined (SLEEP_TIMER_BASEADDR)
  67 #include "xil_sleeptimer.h"
  68 #endif
  69
  70 /****************************  Constant Definitions  ************************/
  71 #if defined (SLEEP_TIMER_BASEADDR)
  72 #define COUNTS_PER_USECOND (SLEEP_TIMER_FREQUENCY / 1000000)
  73 #else
  74 /* Global Timer is always clocked at half of the CPU frequency */
  75 #define COUNTS_PER_USECOND  (XPAR_CPU_CORTEXA9_CORE_CLOCK_FREQ_HZ / (2U*1000000U))
  76 #endif
  77
  78 /*****************************************************************************/
  79 /**
  80 *
  81 * This API gives a delay in microseconds
  82 *
  83 * @param        useconds requested
  84 *
  85 * @return       0 if the delay can be achieved, -1 if the requested delay
  86 *               is out of range
  87 *
  88 * @note         None.
  89 *
  90 ****************************************************************************/
  91 int usleep_A9(unsigned long useconds)
  92 {
  93 #if defined (SLEEP_TIMER_BASEADDR)
  94         Xil_SleepTTCCommon(useconds, COUNTS_PER_USECOND);
  95 #else
  96         XTime tEnd, tCur;
  97
  98         XTime_GetTime(&tCur);
  99         tEnd = tCur + (((XTime) useconds) * COUNTS_PER_USECOND);
 100         do
 101         {
 102                 XTime_GetTime(&tCur);
 103         } while (tCur < tEnd);
 104 #endif
 105
 106         return 0;
 107 }