ICP_ISR:
	push	xl
	in	xl, SREG
	push	xl

	cli
	in	xl, TCCR1B
	andi	xl, 0b01000000			; Maske ICES1-Bit
	tst	xl				; testen, ob steigende oder fallende Flanke
	breq	ICP_ISR2			; eingestellt ist
ICP_ISR1:
	clr	xl				; bei steigender Flanke den Timer
	out	TCNT1H,xl			; auf 0 setzen
	out 	TCNT1L,xl

	ldi	xl, (0<<ICES1)|(1<<CS10)	; auf fallende Flanke 
	out	TCCR1B, xl			; umschalten und zum Ende
	rjmp	ICP_ISR_end
ICP_ISR2:
	in	r21, ICR1L			; bei fallender Flanke den Timer nach r21/r22 kopieren
	in	r22, ICR1H			; und Flag (zur LCD-Ausgabe) setzen.
	sbr	FlagReg, (1<<flEcho)
 
	ldi	xl, (1<<ICES1)|(1<<CS10)	; auf steigende Flanke 
	out	TCCR1B, xl			; umschalten
ICP_ISR_end:
	sei
	pop	xl
	out	SREG, xl
	pop	xl
	reti