;--------------------------------------------------------------------------------
; Hauptprogramm
;--------------------------------------------------------------------------------
Main:
	mov	temp1, FlagReg			; Flankenwechsel?
	andi	temp1, (1<<flEcho)
	cpi	temp1, (1<<flEcho)
	brne	Main_End			; nein -> Ende

						; ja, hier weiter
	in	xl, TCCR1B
	andi	xl, 0b01000000			; Maske ICES1-Bit

	tst	xl				; steigende oder fallende Flanke?
	breq	Main2
Main1:						; steigende Flanke ist eingestellt
	mov	E_StartL, yl			; ...Zählerstand in Reg sichern
	mov	E_StartH, yh
	ldi	xl, (0<<ICES1)|(1<<CS10)	; ...auf fallende Flanke 
	out	TCCR1B, xl			; ...umschalten und zum Ende
	cbr	FlagReg, (1<<flEcho)	
	rjmp	Main_End

Main2:						; fallende Flanke ist eingestellt
	mov	E_StoppL, yl			; ...Zählerstand in Reg sichern
	mov	E_StoppH, yh
	ldi	xl, (1<<ICES1)|(1<<CS10)	; ...auf steigende Flanke umschalten
	out	TCCR1B, xl
	cbr	FlagReg, (1<<flEcho)

	locate	1, 1				; ... beide Zählerwerte im LCD ausgeben
	mov	temp1, E_StartH
	rcall	lcd_number

	locate	1, 5
	mov	temp1, E_StartL
	rcall	lcd_number

	locate	3, 1
	mov	temp1, E_StoppH
	rcall	lcd_number

	locate	3, 5
	mov	temp1, E_StoppL
	rcall	lcd_number
Main_End:
	rjmp	Main


;--------------------------------------------------------------------------------
;ICP		
;--------------------------------------------------------------------------------
ICP_ISR:
	push	xl
	in		xl, SREG
	push	xl

	cli
	in		yl, ICR1L
	in		yh, ICR1H
	sei
	sbr		FlagReg, (1<<flEcho)
ICP_ISR_end:
	pop		xl
	out		SREG, xl
	pop		xl
	reti