firm/bare_metal/common/bfin_util.c

   1 /**
   2  * @file binf_util.c
   3  * @author Copyright(C) 2012 Shinichiro Nakamura
   4  * @brief BlueTank ACB-BF592 Application Sample Codes.
   5  */
   6
   7 /*
   8  * ===============================================================
   9  *  BlueTank
  10  * ===============================================================
  11  * Copyright (c) 2012 Shinichiro Nakamura
  12  *
  13  * Permission is hereby granted, free of charge, to any person
  14  * obtaining a copy of this software and associated documentation
  15  * files (the "Software"), to deal in the Software without
  16  * restriction, including without limitation the rights to use,
  17  * copy, modify, merge, publish, distribute, sublicense, and/or
  18  * sell copies of the Software, and to permit persons to whom the
  19  * Software is furnished to do so, subject to the following
  20  * conditions:
  21  *
  22  * The above copyright notice and this permission notice shall be
  23  * included in all copies or substantial portions of the Software.
  24  *
  25  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  26  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
  27  * OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  28  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
  29  * HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
  30  * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  31  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  32  * OTHER DEALINGS IN THE SOFTWARE.
  33  * ===============================================================
  34  */
  35
  36 #include <cdefBF592-A.h>
  37 #include "bfin_util.h"
  38
  39 void bfin_util_usleep(const uint32_t usec)
  40 {
  41     uint32_t start;
  42     uint32_t now;
  43     uint32_t stop = usec * (1000 / 2.5);
  44     /* 1 cycle = 2.5ns */
  45
  46     asm("%0 = CYCLES;" : "=d"(start));
  47     while (1) {
  48         asm volatile("%0 = CYCLES;" : "=d"(now));
  49         if ((now - start) >= stop) {
  50             break;
  51         }
  52     }
  53 }
  54