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

   1 /******************************************************************************
   2 *
   3 * Copyright (C) 2014 - 2015 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 * </pre>
  49 *
  50 ******************************************************************************/
  51 /***************************** Include Files *********************************/
  52
  53 #include "sleep.h"
  54 #include "xtime_l.h"
  55 #include "xparameters.h"
  56
  57 /*****************************************************************************/
  58 /*
  59 *
  60 * This API is used to provide delays in seconds
  61 *
  62 * @param        seconds requested
  63 *
  64 * @return       0 always
  65 *
  66 * @note         None.
  67 *
  68 ****************************************************************************/
  69 s32 sleep(u32 seconds)
  70 {
  71         XTime tEnd, tCur;
  72         /* Enable the counter only if it is disable */
  73         if(((Xil_In32(XIOU_SCNTRS_BASEADDR + XIOU_SCNTRS_CNT_CNTRL_REG_OFFSET)) & XIOU_SCNTRS_CNT_CNTRL_REG_EN_MASK) != XIOU_SCNTRS_CNT_CNTRL_REG_EN){
  74
  75                 /*write frequency to System Time Stamp Generator Register*/
  76                 Xil_Out32((XIOU_SCNTRS_BASEADDR + XIOU_SCNTRS_FREQ_REG_OFFSET),XIOU_SCNTRS_FREQ);
  77
  78                 /*Enable the counter*/
  79                 Xil_Out32((XIOU_SCNTRS_BASEADDR + XIOU_SCNTRS_CNT_CNTRL_REG_OFFSET),XIOU_SCNTRS_CNT_CNTRL_REG_EN);
  80         }
  81         XTime_GetTime(&tCur);
  82         tEnd  = tCur + (((XTime) seconds) * COUNTS_PER_SECOND);
  83         do
  84         {
  85                 XTime_GetTime(&tCur);
  86         } while (tCur < tEnd);
  87
  88         return 0;
  89 }