/******************** (C) COPYRIGHT 2010 Embest Info&Tech Co.,LTD. ************
* 文件名: core_cm0.c
* 作者  : Wuhan R&D Center, Embest
* 日期  : 01/18/2010
* 描述  : CMSIS Cortex-M0核外圍訪問層源文件
*******************************************************************************
*******************************************************************************
* 歷史:
* 01/18/2010		 : V1.0		   初始版本
*******************************************************************************/
/* Includes ------------------------------------------------------------------*/
#include <stdint.h>

/* 編譯器的特性符號定義 */
#if defined ( __CC_ARM   )
  #define __ASM            __asm           /*!< armcc編譯器asm關鍵字          */
  #define __INLINE         __inline        /*!< armcc編譯器inline關鍵字       */

#elif defined ( __ICCARM__ )
  #define __ASM           __asm            /*!< iarcc編譯器asm關鍵字          */
  #define __INLINE        inline           /*!< iarcc編譯器inline關鍵字       */
  #define __nop           __no_operation   /*!< 無操作 */

#elif defined   (  __GNUC__  )
  #define __ASM             asm            /*!< gcc編譯器asm關鍵字            */
  #define __INLINE          inline         /*!< gcc編譯器inline關鍵字         */
#endif


#if (defined (__ARMCC_VERSION)) && (__ARMCC_VERSION < 400000)


/**
  * @函數名：uint32_t __get_PSP
  * @描述：返回進程堆棧指針
  * @參數： 無
  * @返回值：uint32_t 進程堆棧指針
  *          返回一個具體的進程堆棧指針
  */
__ASM uint32_t __get_PSP(void)
{
  mrs r0, psp
  bx lr
}


/**
  * @函數名：__set_PSP 
  * @描述：設置進程堆棧指針
  * @參數： uint32_t 進程堆棧指針
  * @返回值：無
  *          分配一個進程堆棧指針值給Cortex-M0核PSP寄存器 
  */
__ASM void __set_PSP(uint32_t topOfProcStack)
{
  msr psp, r0
  bx lr
}


/**
  * @函數名：__get_MSP
  * @描述：返回主堆棧指針
  * @參數： 無
  * @返回值：uint32_t 主程堆棧指針
  */
__ASM uint32_t __get_MSP(void)
{
  mrs r0, msp
  bx lr
}


/**
  * @函數名：__set_MSP
  * @描述：設置主堆棧指針
  * @參數：uint32_t 主程堆棧指針
  * @返回值：無
  *          分配一個具體值給MSP主堆棧指針寄存器
  */
__ASM void __set_MSP(uint32_t mainStackPointer)
{
  msr msp, r0
  bx lr
}


/**
  * @函數名：__get_BASEPRI
  * @描述：返回基優先級值
  * @參數：無
  * @返回值：uint32_t 基優先級
  */
__ASM uint32_t  __get_BASEPRI(void)
{
  mrs r0, basepri
  bx lr
}


/**
  * @函數名：__set_BASEPRI
  * @描述：設置基優先級值
  * @參數：uint32_t 基優先級
  * @返回值：無
  */
__ASM void __set_BASEPRI(uint32_t basePri)
{
  msr basepri, r0
  bx lr
}


/**
  * @函數名: __get_PRIMASK
  * @描述：返回優先級屏蔽值
  * @參數：無
  * @返回值：uint32_t 優先級屏蔽值
  */
__ASM uint32_t __get_PRIMASK(void)
{
  mrs r0, primask
  bx lr
}


/**
  * @函數名：__set_PRIMASK
  * @描述：設置優先級屏蔽寄存器
  * @參數：uint32_t 優先級屏蔽值
  * @返回值：無           
  */
__ASM void __set_PRIMASK(uint32_t priMask)
{
  msr primask, r0
  bx lr
}


/**
  * @函數名：__get_FAULTMASK 
  * @描述：返回故障屏蔽寄存器值
  * @參數：無
  * 返回值：uint32_t 故障屏蔽值           
  */
__ASM uint32_t  __get_FAULTMASK(void)
{
  mrs r0, faultmask
  bx lr
}


/**
 * @函數名：__set_FAULTMASK
 * @描述：設置故障屏蔽寄存器
 * @參數：uint32_t 故障屏蔽值
 * @返回值：無         
 */
__ASM void __set_FAULTMASK(uint32_t faultMask)
{
  msr faultmask, r0
  bx lr
}


/**
  * 函數名：__get_CONTROL
  * @描述：返回控制寄存器值
  * @參數: 無
  * @返回值: uint32_t 控制寄存器值
  */
__ASM uint32_t  __get_CONTROL(void)
{
  mrs r0, control
  bx lr
}

/**
 * @函數名：__set_CONTROL
 * @描述：設置控制寄存器
 * @參數：uint32_t 控制寄存器值
 * @返回值：無
 */
__ASM void __set_CONTROL(uint32_t control)
{
  msr control, r0
  bx lr
}


/**
  * @函數名：__REV16
  * @描述：反轉unsigned short類型字節順序
  * @參數：uint16_t value 待轉換值
  * @返回值：uint32_t 轉換后的值
  */
__ASM uint32_t __REV16(uint16_t value)
{
  rev16 r0, r0
  bx lr
}


/**
  * @函數名：__REVSH
  * @描述：反轉signed short類型值字節順序并進行符號擴展
  * @參數：int16_t value待轉換值
  * @返回值：int32_t 轉換后的值
  */
__ASM int32_t __REVSH(int16_t value)
{
  revsh r0, r0
  bx lr
}



#elif (defined (__ICCARM__))
#pragma diag_suppress=Pe940

/**
  * @函數名：__get_PSP
  * @描述：返回進程堆棧指針
  * @參數：無
  * @返回值：uint32_t 進程堆棧指針
  */
uint32_t __get_PSP(void)
{
  __ASM("mrs r0, psp");
  __ASM("bx lr");
}

/**
  * @函數名：__set_PSP
  * @描述：設置進程堆棧指針
  * @參數：uint32_t 進程堆棧指針
  * @返回值：無
  *          為PSP堆棧指針寄存器分配一個值
  */
void __set_PSP(uint32_t topOfProcStack)
{
  __ASM("msr psp, r0");
  __ASM("bx lr");
}

/**
  * @函數名：__get_MSP
  * @描述：返回主堆棧指針
  * @參數：無
  * @返回值： uint32_t 主堆棧指針
  */
uint32_t __get_MSP(void)
{
  __ASM("mrs r0, msp");
  __ASM("bx lr");
}

/**
  * @函數名：__set_MSP
  * @描述：設置主堆棧指針
  * @參數：uint32_t 主堆棧指針
  * @返回值：無
  *         為MSP主堆棧指針寄存器分配一個值
  */
void __set_MSP(uint32_t topOfMainStack)
{
  __ASM("msr msp, r0");
  __ASM("bx lr");
}


/**
  * @函數名：__REV16
  * @描述：反轉unsigned short類型值字節順序
  * @參數：uint16_t value等轉換值
  * @返回值：uint32_t 轉換后的值
  */
uint32_t __REV16(uint16_t value)
{
  __ASM("rev16 r0, r0");
  __ASM("bx lr");
}


/**
  * @函數名：__RBIT
  * @描述：反轉一個值二進制位順序
  * @參數：uint32_t value待轉換值
  * @返回值：uint32_t 轉換后的值
  */
uint32_t __RBIT(uint32_t value)
{
  __ASM("rbit r0, r0");
  __ASM("bx lr");
}

/**
  * @函數名：__LDREXB
  * @描述： LDR Exclusive
  * @參數： uint8_t* address
  * @返回值： uint8_t (*address)值
  */
uint8_t __LDREXB(uint8_t *addr)
{
  __ASM("ldrexb r0, [r0]");
  __ASM("bx lr"); 
}

/**
  * @函數名：__LDREXH
  * @描述：LDR Exclusive
  * @參數： uint16_t* address
  * @返回值：uint16_t (*address)值
  *          Exclusive LDR 指令
  */
uint16_t __LDREXH(uint16_t *addr)
{
  __ASM("ldrexh r0, [r0]");
  __ASM("bx lr");
}


/**
  * @函數名：__LDREXW
  * @描述：LDR Exclusive
  * @參數： uint32_t* address
  * @返回值：uint32_t (*address)值
  * Exclusive LDR 指令
  */
uint32_t __LDREXW(uint32_t *addr)
{
  __ASM("ldrex r0, [r0]");
  __ASM("bx lr");
}


/**
  * @函數名：__STREXB
  * @描述：STR Exclusive
  * @參數：uint8_t *address
  * @參數： uint8_t value待存儲值
  * @返回值：uint32_t 成功/失敗
  *          Exclusive STR 指令  */
uint32_t __STREXB(uint8_t value, uint8_t *addr)
{
  __ASM("strexb r0, r0, [r1]");
  __ASM("bx lr");
}


/**
  * @函數名：__STREXH
  * @描述： STR Exclusive
  * @參數： uint16_t *address
  * @參數： uint16_t value待存儲值
  * @返回值：uint32_t 成功/失敗
  *          Exclusive STR 指令
  */
uint32_t __STREXH(uint16_t value, uint16_t *addr)
{
  __ASM("strexh r0, r0, [r1]");
  __ASM("bx lr");
}


/**
  * @函數名：__STREXW
  * @描述：STR Exclusive
  * @參數：uint32_t *address