/* 
   Precise Delay Functions 
   V 0.5, Martin Thomas, 9/2004
   
   In the original Code from Peter Dannegger a timer-interrupt
   driven "timebase" has been used for precise One-Wire-Delays.
   My loop-approach is less elegant but may be more usable 
   as library-function. Since it's not "timer-dependent"
   See also delay.h.
   
   Inspired by the avr-libc's loop-code
*/

#include <avr/io.h>
#include <avr/io.h>
#include <inttypes.h>

#include "delay2.h"
#include "timer.h"

void delayloop32(uint32_t loops) 
{
  __asm__ volatile ( "cp  %A0,__zero_reg__ \n\t"  \
                     "cpc %B0,__zero_reg__ \n\t"  \
                     "cpc %C0,__zero_reg__ \n\t"  \
                     "cpc %D0,__zero_reg__ \n\t"  \
                     "breq L_Exit_%=       \n\t"  \
                     "L_LOOP_%=:           \n\t"  \
                     "subi %A0,1           \n\t"  \
                     "sbci %B0,0           \n\t"  \
                     "sbci %C0,0           \n\t"  \
                     "sbci %D0,0           \n\t"  \
                     "brne L_LOOP_%=            \n\t"  \
                     "L_Exit_%=:           \n\t"  \
                     : "=w" (loops)              \
					 : "0"  (loops)              \
                   );                             \
    
	return;
}
//------------------------------------------------------------------------------
// 	delay ~ 1us * count for F_CPU = 14745600;

void delay1(u16 count)
{
 u08 j;

 for (j=0;j<count;j++) {
	__asm__ volatile ( \
 		"nop\n\t" \
		"nop\n\t" \
		"nop\n\t" \
		"nop\n\t" \
		"nop\n\t" \
		"nop\n\t" \
  	);
 }

}

//------------------------------------------------------------------------------
void delay1us(volatile u08 delay, u08 count)
{
	timer0_source(CK);
	while (count-- !=0)
	{
		timer0_start();
		while (TCNT0 < delay);

	}
}
//------------------------------------------------------------------------------