#include "sys.h"  

#include "type.h"

#include "cpm_drv.h"

#include "tc_drv.h"

#include "delay.h"

#include "libRegOpt.h"

#include "clk_switch_drv.h"

#include "cache_drv.h"

UINT32 g_sys_clk;//系统时钟全局变量

UINT32 g_ips_clk;

UINT32 g_trim_clk = OSC_160M_HZ;

//设置向量表偏移地址

//NVIC_VectTab:基址

//Offset:偏移量		 

void NVIC_SetVectorTable(UINT32 NVIC_VectTab,UINT32 Offset)	 

{ 	   	  

	SCB->VTOR=NVIC_VectTab|(Offset&(UINT32)0xFFFFFE00);//设置NVIC的向量表偏移寄存器,VTOR低9位保留,即[8:0]保留。

}

//设置NVIC分组

//NVIC_Group:NVIC分组 0~4 总共5组 		   

void NVIC_PriorityGroupConfig(UINT8 NVIC_Group)	 

{ 

	UINT32 temp,temp1;	  

	temp1=(~NVIC_Group)&0x07;//取后三位

	temp1<<=8;

	temp=SCB->AIRCR;  //读取先前的设置

	temp&=0X0000F8FF; //清空先前分组

	temp|=0X05FA0000; //写入钥匙

	temp|=temp1;	   

	SCB->AIRCR=temp;  //设置分组	    	  				   

}

//设置NVIC 

//NVIC_PreemptionPriority:抢占优先级

//NVIC_SubPriority       :响应优先级

//NVIC_Channel           :中断编号

//NVIC_Group             :中断分组 0~3

//注意优先级不能超过设定的组的范围!否则会有意想不到的错误

//组划分:

//组0:0位抢占优先级,3位响应优先级

//组1:1位抢占优先级,2位响应优先级

//组2:2位抢占优先级,1位响应优先级

//组3:3位抢占优先级,0位响应优先级

//NVIC_SubPriority和NVIC_PreemptionPriority的原则是,数值越小,越优先	   

void NVIC_Init(UINT8 NVIC_PreemptionPriority,UINT8 NVIC_SubPriority,UINT8 NVIC_Channel,UINT8 NVIC_Group)	 

{ 

	UINT32 temp;	  

	NVIC_PriorityGroupConfig(NVIC_Group);//设置分组

	temp=NVIC_PreemptionPriority<<(3-NVIC_Group);	  

	temp|=NVIC_SubPriority&(0x07>>NVIC_Group);

	temp&=0x7;								//取低三位

	NVIC->ISER[NVIC_Channel/32]|=1<<NVIC_Channel%32;//使能中断位(要清除的话,设置ICER对应位为1即可)

	NVIC->IP[NVIC_Channel]|=temp<<5;				//设置响应优先级和抢断优先级   	    	  				   

} 

////外部中断配置函数

////只针对GPIOA~I;不包括PVD,RTC,USB_OTG,USB_HS,以太网唤醒等

////参数:

////GPIOx:0~8,代表GPIOA~I

////BITx:需要使能的位;

////TRIM:触发模式,1,下升沿;2,上降沿;3，任意电平触发

////该函数一次只能配置1个IO口,多个IO口,需多次调用

////该函数会自动开启对应中断,以及屏蔽线   	    

//void Ex_NVIC_Config(UINT8 GPIOx,UINT8 BITx,UINT8 TRIM) 

//{ 

//	UINT8 EXTOFFSET=(BITx%4)*4;  

//	RCC->APB2ENR|=1<<14;  						//使能SYSCFG时钟  

//	SYSCFG->EXTICR[BITx/4]&=~(0x000F<<EXTOFFSET);//清除原来设置！！！

//	SYSCFG->EXTICR[BITx/4]|=GPIOx<<EXTOFFSET;	//EXTI.BITx映射到GPIOx.BITx 

//	//自动设置

//	EXTI->IMR|=1<<BITx;					//开启line BITx上的中断(如果要禁止中断，则反操作即可)

//	if(TRIM&0x01)EXTI->FTSR|=1<<BITx;	//line BITx上事件下降沿触发

//	if(TRIM&0x02)EXTI->RTSR|=1<<BITx;	//line BITx上事件上升降沿触发

//} 	

//THUMB指令不支持汇编内联

//采用如下方法实现执行汇编指令WFI  

//进入待机模式	  

void Sys_Standby(void)

{ 

	SCB->SCR|=1<<2;		//使能SLEEPDEEP位 (SYS->CTRL)	   

//	RCC->APB1ENR|=1<<28;//使能电源时钟 

//	PWR->CSR|=1<<8;     //设置WKUP用于唤醒

//	PWR->CR|=1<<2;      //清除Wake-up 标志

//	PWR->CR|=1<<1;      //PDDS置位

	if((CPM->CPM_SLPCFGR & 0x80000000) == 0)

	{

//		CPM->CPM_PWRCR &=~ 0x0c;	//disable LVD if enter lp/poff1/poff1.5 mode.

		CPM_PWRCR_OptBits(0x0c,RESET);

	}

	else

	{

//		CPM->CPM_PWRCR |= 0x0c;		//enable LVD if enter poff2 mode.

		CPM_PWRCR_OptBits(0x0c,SET);

	}

	WFI_SET();			//执行WFI指令,进入待机模式

//	CPM->CPM_PWRCR |= 0x0c;		//enable LVD after wake-up from lowpower.

	CPM_PWRCR_OptBits(0x0c,SET);

}	     

//系统软复位   

void Sys_Soft_Reset(void)

{   

	SCB->AIRCR =0X05FA0000|(UINT32)0x04;	  

} 		 

void Sys_Init(void)

{

	/*TC has been closed in startup_ARMCM4.s*/

//	TC_Reset_Init(TC_WDP_0_5, 0xffff, FALSE); // disable TC reset

	delay(250000);	//调试时钟建议打开，预防修改时钟失败导致无法仿真

	#if OSC_Frequency

	Sys_Clk_Init(OSC_150M_HZ, SYS_CLK_DIV_1,IPS_CLK_DIV_2);

	#else

	Sys_Clk_Init(OSC_120M_HZ, SYS_CLK_DIV_1,IPS_CLK_DIV_2);

	#endif

	//开启EFLASH加速模块

	DCACHE_Init(cacheOff, cacheThrough, cacheOff, cacheOff);

	ICACHE_Init(cacheOff, cacheThrough, cacheOff, cacheOff);

	//	CPM_VCC5V_Bypass(); //芯片3.3V或1.8V供电时，对功耗要求高，建议打开此接口，对功耗要求不高可以不打开; 芯片5V供电时必须屏蔽此接口,否则可能坏芯片！！！

}

void WFI_SET(void)

{

	__ASM volatile("wfi");		  

}

//关闭所有中断(但是不包括fault和NMI中断)

void INTX_DISABLE(void)

{

	__ASM volatile("cpsid i");

}

//开启所有中断

void INTX_ENABLE(void)

{

	__ASM volatile("cpsie i");		  

}

//设置栈顶地址

//addr:栈顶地址

__asm void MSR_MSP(UINT32 addr) 

{

	MSR MSP, r0 			//set Main Stack value

	BX r14

}