uzumeapp/kernel/config/blackfin/bsp_bluetank/bfin_util.c

   1 /**
   2  * @file binf_util.c
   3  * @author Shinichiro Nakamura
   4  * @brief BlueTank ACB-BF592 Application Sample Codes.
   5  */
   6
   7 /*
   8  * ===============================================================
   9  * BlueTank
  10  * ===============================================================
  11  * Copyright (c) 2012-2013 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 <builtins.h>
  37 #include <cdefBF592-A.h>
  38 #include "bfin_util.h"
  39
  40 void bfin_util_usleep(const uint32_t usec)
  41 {
  42     uint32_t start;
  43     uint32_t now;
  44     uint32_t stop = usec * (1000 / 2.5);
  45     /* 1 cycle = 2.5ns */
  46
  47     asm("%0 = CYCLES;" : "=d"(start));
  48     while (1) {
  49         asm volatile("%0 = CYCLES;" : "=d"(now));
  50         if ((now - start) >= stop) {
  51             break;
  52         }
  53     }
  54 }
  55
  56 /* Visual DSP++のregister_handler関数実装 */
  57 void bfin_util_register_handler(interrupt_kind kind, ex_handler_fn_gcc fn)
  58 {
  59     uint32_t l_mask;
  60
  61     if ((ik_emulation > kind) || (kind > ik_ivg15)) {
  62       return;
  63     }
  64
  65     *((ex_handler_fn_gcc*)&(((uint32_t*)EVT0)[(int32_t)kind])) = fn;
  66     l_mask  = cli();
  67     l_mask |= 1u << (int32_t)kind;
  68     sti(l_mask);
  69 }
  70