123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268 |
- #include "delay.h"
- #define SYSTEM_SUPPORT_OS 1
- #if SYSTEM_SUPPORT_OS
- #include "includes.h"
- #endif
- static u8 fac_us=0;
- static u16 fac_ms=0;
- #if SYSTEM_SUPPORT_OS
- #ifdef OS_CRITICAL_METHOD
- #define delay_osrunning OSRunning
- #define delay_ostickspersec OS_TICKS_PER_SEC
- #define delay_osintnesting OSIntNesting
- #endif
- #ifdef CPU_CFG_CRITICAL_METHOD
- #define delay_osrunning OSRunning
- #define delay_ostickspersec OSCfg_TickRate_Hz
- #define delay_osintnesting OSIntNestingCtr
- #endif
- void delay_osschedlock(void)
- {
- #ifdef CPU_CFG_CRITICAL_METHOD
- OS_ERR err;
- OSSchedLock(&err);
- #else
- OSSchedLock();
- #endif
- }
- void delay_osschedunlock(void)
- {
- #ifdef CPU_CFG_CRITICAL_METHOD
- OS_ERR err;
- OSSchedUnlock(&err);
- #else
- OSSchedUnlock();
- #endif
- }
- void delay_ostimedly(u32 ticks)
- {
- #ifdef CPU_CFG_CRITICAL_METHOD
- OS_ERR err;
- OSTimeDly(ticks,OS_OPT_TIME_PERIODIC,&err);
- #else
- OSTimeDly(ticks);
- #endif
- }
-
- extern void systick_add(uint32_t tms);
- void SysTick_Handler(void)
- {
- if(delay_osrunning==1)
- {
- OSIntEnter();
- OSTimeTick();
- OSIntExit();
- systick_add(1000/OS_TICKS_PER_SEC);
- }
- }
- #endif
-
- void delay_init()
- {
- #if SYSTEM_SUPPORT_OS
- u32 reload;
- #endif
- SysTick_CLKSourceConfig(SysTick_CLKSource_HCLK_Div8);
- fac_us=SystemCoreClock/8000000;
- #if SYSTEM_SUPPORT_OS
- reload=SystemCoreClock/8000000;
- reload*=1000000/delay_ostickspersec;
-
- fac_ms=1000/delay_ostickspersec;
- SysTick->CTRL|=SysTick_CTRL_TICKINT_Msk;
- SysTick->LOAD=reload;
- SysTick->CTRL|=SysTick_CTRL_ENABLE_Msk;
- #else
- fac_ms=(u16)fac_us*1000;
- #endif
- }
- #if SYSTEM_SUPPORT_OS
- void delay_us(u32 nus)
- {
- u32 ticks;
- u32 told,tnow,tcnt=0;
- u32 reload=SysTick->LOAD;
- ticks=nus*fac_us;
- tcnt=0;
- delay_osschedlock();
- told=SysTick->VAL;
- while(1)
- {
- tnow=SysTick->VAL;
- if(tnow!=told)
- {
- if(tnow<told)tcnt+=told-tnow;
- else tcnt+=reload-tnow+told;
- told=tnow;
- if(tcnt>=ticks)break;
- }
- };
- delay_osschedunlock();
- }
- void delay_ms(u16 nms)
- {
- if(delay_osrunning&&delay_osintnesting==0)
- {
- if(nms>=fac_ms)
- {
- delay_ostimedly(nms/fac_ms);
- }
- nms%=fac_ms;
- }
- delay_us((u32)(nms*1000));
- }
- #else
- void delay_us(u32 nus)
- {
- u32 temp;
- SysTick->LOAD=nus*fac_us;
- SysTick->VAL=0x00;
- SysTick->CTRL|=SysTick_CTRL_ENABLE_Msk ;
- do
- {
- temp=SysTick->CTRL;
- }while((temp&0x01)&&!(temp&(1<<16)));
- SysTick->CTRL&=~SysTick_CTRL_ENABLE_Msk;
- SysTick->VAL =0X00;
- }
- void delay_ms(u16 nms)
- {
- u32 temp;
- SysTick->LOAD=(u32)nms*fac_ms;
- SysTick->VAL =0x00;
- SysTick->CTRL|=SysTick_CTRL_ENABLE_Msk ;
- do
- {
- temp=SysTick->CTRL;
- }while((temp&0x01)&&!(temp&(1<<16)));
- SysTick->CTRL&=~SysTick_CTRL_ENABLE_Msk;
- SysTick->VAL =0X00;
- }
- #endif
|