delay.c

来自「BlackFin与摄像头的接口程序」· C语言 代码 · 共 24 行

#include <cycle_count_bf.h>

//local includes
#include "delay.h"

/// wait 1ms * pa_nMsec using the cycle counters
void bs_delay(unsigned short pa_nMsec) {
	
	unsigned long cclk, sclk, vco;
	adi_pwr_GetFreq(&cclk, &sclk, &vco);
	
	unsigned long long int cur = 0;
	unsigned long long int nd = 0;
	
	_GET_CYCLE_COUNT(cur);
	
	nd = cur + pa_nMsec * 1000 * cclk;
	
	while (cur < nd) {
		_GET_CYCLE_COUNT(cur);
	}
}