git.sur5r.net Git - freertos/blob - FreeRTOS/Demo/MicroBlaze_Kintex7_EthernetLite/BSP/microblaze_0/libsrc/standalone_v4_2/src/microblaze_sleep.c

   1 /******************************************************************************
   2 *
   3 * Copyright (C) 2014 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 microblaze_sleep.c
  36 *
  37 * Contains implementation of microblaze sleep function.
  38 *
  39 * <pre>
  40 * MODIFICATION HISTORY:
  41 *
  42 * Ver   Who  Date        Changes
  43 * ----- ---- -------- -------------------------------------------------------
  44 * 4.1   hk   04/18/14 Add sleep function.
  45 *
  46 * </pre>
  47 *
  48 * @note
  49 *
  50 * This file may contain architecture-dependent code.
  51 *
  52 ******************************************************************************/
  53
  54 /***************************** Include Files *********************************/
  55
  56 #include "microblaze_sleep.h"
  57
  58 /************************** Constant Definitions *****************************/
  59
  60
  61 /**************************** Type Definitions *******************************/
  62
  63
  64 /***************** Macros (Inline Functions) Definitions *********************/
  65
  66
  67 /************************** Function Prototypes ******************************/
  68
  69
  70
  71 /*****************************************************************************/
  72 /**
  73 *
  74 * Provides delay for requested duration.
  75 *
  76 * @param        Delay time in milliseconds.
  77 *
  78 * @return       None.
  79 *
  80 * @note         Instruction cache should be enabled for this to work.
  81 *
  82 ******************************************************************************/
  83 void MB_Sleep(unsigned int MilliSeconds)
  84 {
  85         if (((mfmsr() & 0x20) == 0)) {
  86                 /*
  87                  * Instruction cache not enabled.
  88                  * Delay will be much higher than expected.
  89                  */
  90         }
  91
  92         asm volatile ("\n"
  93                         "1:               \n\t"
  94                         "addik r7, r0, %0 \n\t"
  95                         "2:               \n\t"
  96                         "addik r7, r7, -1 \n\t"
  97                         "bneid  r7, 2b    \n\t"
  98                         "or  r0, r0, r0   \n\t"
  99                         "bneid %1, 1b     \n\t"
 100                         "addik %1, %1, -1 \n\t"
 101                         :: "i"(ITERS_PER_MSEC), "d" (MilliSeconds));
 102
 103 }