typedef void (*voidFunc)(void);
#define CRGCTL *((unsigned char *)(0x34 + 0x7))
#define CRGINT *((unsigned char *)(0x34 + 0x4))
#define CRGFLG *((unsigned char *)(0x34 + 0x3))

void initCRG(void (*fp)(void)) 
{
	// set intervall
	CRGCTL = 0x40;
	
	// aktivera crg
	CRGINT = 0x80;
	
	// init avbrottsvektorn
	*((voidFunc *) 0x3ff0) = fp;
}

void kvitteraCRG(void)
{
	CRGFLG = 0x80;
}