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

   1 /******************************************************************************
   2 *
   3 * Copyright (C) 2009 - 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 xtime_l.c
  35 *
  36 * This file contains low level functions to get/set time from the Global Timer
  37 * register in the ARM Cortex A9 MP core.
  38 *
  39 * <pre>
  40 * MODIFICATION HISTORY:
  41 *
  42 * Ver   Who    Date     Changes
  43 * ----- ------ -------- ---------------------------------------------------
  44 * 1.00a rp/sdm 11/03/09 Initial release.
  45 * 3.07a sgd    07/05/12 Upadted get/set time functions to make use Global Timer
  46 * </pre>
  47 *
  48 * @note         None.
  49 *
  50 ******************************************************************************/
  51 /***************************** Include Files *********************************/
  52
  53 #include "xtime_l.h"
  54 #include "xpseudo_asm.h"
  55 #include "xil_types.h"
  56 #include "xil_assert.h"
  57 #include "xil_io.h"
  58
  59 /***************** Macros (Inline Functions) Definitions *********************/
  60
  61 /**************************** Type Definitions *******************************/
  62
  63 /************************** Constant Definitions *****************************/
  64
  65 /************************** Variable Definitions *****************************/
  66
  67 /************************** Function Prototypes ******************************/
  68
  69 /****************************************************************************/
  70 /**
  71 * @brief        Set the time in the Global Timer Counter Register.
  72 *
  73 * @param        Xtime_Global: 64-bit Value to be written to the Global Timer
  74 *                       Counter Register.
  75 *
  76 * @return       None.
  77 *
  78 * @note         When this function is called by any one processor in a multi-
  79 *                       processor environment, reference time will reset/lost for all
  80 *                       processors.
  81 *
  82 ****************************************************************************/
  83 void XTime_SetTime(XTime Xtime_Global)
  84 {
  85         /* Disable Global Timer */
  86         Xil_Out32((u32)GLOBAL_TMR_BASEADDR + (u32)GTIMER_CONTROL_OFFSET, (u32)0x0);
  87
  88         /* Updating Global Timer Counter Register */
  89         Xil_Out32((u32)GLOBAL_TMR_BASEADDR + (u32)GTIMER_COUNTER_LOWER_OFFSET, (u32)Xtime_Global);
  90         Xil_Out32((u32)GLOBAL_TMR_BASEADDR + (u32)GTIMER_COUNTER_UPPER_OFFSET,
  91                 (u32)((u32)(Xtime_Global>>32U)));
  92
  93         /* Enable Global Timer */
  94         Xil_Out32((u32)GLOBAL_TMR_BASEADDR + (u32)GTIMER_CONTROL_OFFSET, (u32)0x1);
  95 }
  96
  97 /****************************************************************************/
  98 /**
  99 * @brief        Get the time from the Global Timer Counter Register.
 100 *
 101 * @param        Xtime_Global: Pointer to the 64-bit location which will be
 102 *                       updated with the current timer value.
 103 *
 104 * @return       None.
 105 *
 106 * @note         None.
 107 *
 108 ****************************************************************************/
 109 void XTime_GetTime(XTime *Xtime_Global)
 110 {
 111         u32 low;
 112         u32 high;
 113
 114         /* Reading Global Timer Counter Register */
 115         do
 116         {
 117                 high = Xil_In32(GLOBAL_TMR_BASEADDR + GTIMER_COUNTER_UPPER_OFFSET);
 118                 low = Xil_In32(GLOBAL_TMR_BASEADDR + GTIMER_COUNTER_LOWER_OFFSET);
 119         } while(Xil_In32(GLOBAL_TMR_BASEADDR + GTIMER_COUNTER_UPPER_OFFSET) != high);
 120
 121         *Xtime_Global = (((XTime) high) << 32U) | (XTime) low;
 122 }