; кварц на 16 мгц
; внутренний делитель отключен

; не работает






.include 	"tn2313adef.inc"	; используем tiny2313a


.def	Temp=R16
.def	Temp1=R17
.def	Temp2=R18
.def	Temp3=R19
.def	Temp4=R20			; регистр сохранения регистра SREG
.def	Temp5=R21
.def	Temp6=R22			; флаг
.def	Temp7=R23			; 
.def	Temp8=R24
.def	Temp9=R25










;******************************************************************************
; оперативка
;******************************************************************************



.dseg					; оперативка



ch_count: .byte 1			; номер импульса // 0,1,2 каналы
					; если = 3, то это синхроимпульс
					; если = 4, то это рассинхронизация или старт МК 

impuls_len: .byte 2			; зарезервируем 2 байта в ОЗУ = переменная для хранения данных считаных с таймера





;******************************************************************************
; константы
;******************************************************************************




.EQU	Chastota_const=0x9C40 		; вершина ШИМ для серопривода ( частота 50 Гц )
					; 50Гц=0,02сек
					; 1 тик таймера = 0,0000005 сек
					; 0,02/0,0000005=40000 ( 0x9C40 )






;******************************************************************************
; программный сегмент 
;******************************************************************************

.cseg

			

.org 0
rjmp RESET				; External Pin, Power-on Reset, Brown-out Reset, and Watchdog Reset




.org ICP1addr				; = 0x0003 Timer/Counter1 Capture Event ( прерывание по захвату )
rjmp ICP1_interruption




.org INT_VECTORS_SIZE








;******************************************************************************
; старт ***********************************************************************
;******************************************************************************

reset:					; включение микроконтроллера



	cli				; глобальный запрет на прерывания


	ldi Temp,low(RamEnd)		; инициализации стека	
	out SPL,Temp			;



	
	ldi Temp,0b11111111		; настроили порт "В" (0-ввод, 1-вывод)
	out DDRB,Temp			; 
					 
		
	ldi Temp,0b00000000		; выводим лог_0
	out PortB,Temp			; 



		
												 
	ldi Temp,0b00111111		; настраиваем порт "D" (0-ввод, 1-вывод)
	out DDRD,Temp 			; 0х000000 - вход с приемника (ICP)
					



	ldi Temp,0b00000000		; выводим лог_0
	out PortD,Temp			;



	RCALL	LCD_INIT		; инициализация дисплея




;******************************************************************************
;  настраиваем таймер_1
;******************************************************************************



; ШИМ для сервы ( аппаратный )
; ICP для измерения длительности импульса.


					

	ldi Temp,(0<<COM1A0)|(0<<COM1A1)|(0<<COM1A0)|(1<<COM1B1)|(1<<WGM11)|(1<<WGM10)
	out TCCR1A,Temp	
				
					; быстрый ШИМ с вершиной в OCR1A // очистить по совпадению, установить при сбросе
					; *1 ( ШИМ с регулируемой частотой )
					; генерации на OC1A в этом режиме нет! отключен!


					; COM1A1  / поведение вывода OC1A // 
					; COM1A0  / поведение вывода OC1A // 
					; COM1B1  / поведение вывода OC1B // 
					; COM1B0  / поведение вывода OC1B //  
					; WGM11=1 / режим *
					; WGM10=0 / режим *





	ldi Temp,(0<<ICES1)|(1<<WGM13)|(1<<WGM12)|(1<<cs11)	
	out TCCR1B,Temp					
					; захват с ноги ICP по падающему фронту							;*****
					; тактовый сигнал таймера 1/8 ( 1 тик таймера = 0,5 мкс )
					; *1



					; тактовый сигнал = CK 1:8 (16МГц/8=2Мгц) 1 тик таймера = 0,5 мкс
					; таймер начал считать!!!

					; ICNC1=0 / фильтр шума на контакте ICP // отключено
					; ICES1=0 / захват с ноги ICP по падающему фронту
					; WGM13=1 / режим *
					; WGM12=1 / режим * Быстрый ШИМ ( Fast PWM )
					; CS12=0  / тактовый сигнал
					; CS11=1  / тактовый сигнал 
					; CS10=0  / тактовый сигнал = CK 1:8 (16МГц/8=2Мгц) 1 тик таймера = 0,5 мкс




	LDI Temp,high(Chastota_const)	; зададим Частоту ШИМ ( установим вершину ШИМ )
	OUT OCR1AH,Temp			; и выведем ее в порт сравнения
	LDI Temp,low(Chastota_const)							
	OUT OCR1AL,Temp	





	ldi Temp,(1<<ICIE1)		;  прерывание по захвату включено
	out TIMSK,Temp

					; TOIE1=0  / прерывание по переполнению счетчика таймера_1 // отключено
					; OCIE1A=0 / прерывание компатора_A таймера_1 // отключено 
					; OCIE1B=0 / прерывание компатора_B таймера_1 // отключено
					; ICIE1=1  / прерывание по захвату // включено
					; OCIE0B=0 / прерывание компатора_B таймера_0 // отключено
					; TOIE=0   / прерывание по переполнению счетчика таймера_0 // отключено
					; OCIE0A=0 / прерывание компатора_A таймера_0 // отключено











	ldi xh, 0xF			; 4000 = 0xFA0 - крайнее положение сервопривода... ( 2 милисекунды )
	ldi xl, 0xA0


	OUT OCR1BH,XH			; зададим длину импульса ( среднее положение )
	OUT OCR1BL,XL			; и выведем ее в порт сравнения






;******************************************************************************
; сброс таймеров
;******************************************************************************


	ldi Temp,0
	STS impuls_len, Temp		; обнуляем данные таймера в оперативке
	STS impuls_len+1, Temp		; 


	ldi Temp,0			; обнуление таймера_1
	out TCNT1H,Temp
	out TCNT1L,Temp

	sei				; глобальное разрешение прерываний




	

;*******************************************************************************
; главный цикл *****************************************************************
;*******************************************************************************


Main_cicle:


	
	rjmp Main_cicle			; циклимся






;*******************************************************************************
; ОБРАБОТКА ПРЕРЫВАНИЯ 
;*******************************************************************************

ICP1_interruption:
	


	in temp4,SREG			; сохраняем "SREG"/////////////////////////////////////////////////////
	push temp4


;*******************************************************************************



	in XL,ICR1L 			; читаем младший байт счетчика
	in XH,ICR1H 			; читаем старший байт счетчика

;*******************************************************************************

	lds ZL, impuls_len		; загружаем (читаем )  в "z" данные таймера с прошлого раза 
	lds ZH, impuls_len+1


	STS impuls_len, XL		; сохраняем данные счетчика полученные в этот раз
	STS impuls_len+1, XH		; 



	mov YH,ZH			; копируем  данные таймера с прошлого раза 
	mov YL,ZL


	mov Temp,XH			; копируем данные таймера полученные сейчас
	mov Temp1,XL

	rcall compare_XY16		; сравниваем...


	breq menshe_2			; переход на обработку когда X=Y ( сейчас число равно тому, что было в прошлый раз )
	brcs menshe_2			; переход на обработку когда X<Y ( сейчас число меньше чем в прошлый раз )
	rjmp bolshe_2			; переход на обработку когда X>Y ( сейчас число больше чем в прошлый раз )


;**************************************************************************************************************
; вычисление длины импульса, если таймер был переполнен
;**************************************************************************************************************

menshe_2:



	SUB ZL, XL			; из большего вычитаем меньшее
	SBC ZH, XH			;

	ldi XH, high(Chastota_const)	; загружаем число 40000
	ldi XH, low(Chastota_const)

	SUB XL, ZL			; вычисляем длительность импульса
	SBC XH, ZH			; длительность канала находится в "Х"

	rjmp prodolzaem			; 

;**************************************************************************************************************
; вычисление длины импульса, если таймер НЕ БЫЛ переполнен
;**************************************************************************************************************

bolshe_2:


	SUB XL, ZL			; вычисляем длительность импульса
	SBC XH, ZL			; длительность канала находится в "Х"

	rjmp prodolzaem			; 

;**************************************************************************************************************
; проверка синхронизации ( а так-же нужно при включении мк )
;**************************************************************************************************************

prodolzaem:



	LDS Temp, ch_count		; читаем номер импульса


	cpi Temp, 4			; флаг рассинхронизации установлен ?
	brne work			; флаг снят, Все сихронизировано!!!!
	rjmp sinhro			; флаг установлен, требуется синхронизация





;*********************************************************************************
; сравниваем полученную длительность с 13 мс ( 0b110010110010000 ) ( 0x6590 )
;*********************************************************************************

sinhro:

	mov Temp,XH			; копируем  "Х"
	mov Temp1,XL



	ldi YH,0x65			; записываем в регистровую пару "Y" 13мс  0x6590
	ldi YL,0x90



	rcall compare_XY16		; сравниваем...

	breq bolshe			; переход на обработку когда X=Y 
	brcs menshe			; переход на обработку когда X<Y
	rjmp bolshe			; переход на обработку когда X>Y 





;*****************************************************************************************
; 
;*****************************************************************************************




bolshe:					; это синхроимпульс! 


	ldi Temp, 0			; снимаем флаг включения_МК, устанавливаем флаг 0-го канала 
	sts ch_count, Temp

	rjmp out_1			; выход






menshe:					; это был не синхроимпульс!

	rjmp out_1			; выход







;*****************************************************************************************
; все синхронизировано, можно работать
;*****************************************************************************************


work:						;



channal_check_0:				; проверка канала_0


	LDS Temp, ch_count			; читаем номер импульса


	cpi Temp, 0				; это 0-ой канал ?
	brne channal_check_1			; нет
	rjmp channal_0				; да






channal_check_1:				; проверка канала_1


	LDS Temp, ch_count			; читаем номер импульса


	cpi Temp, 1				; это 1-ый канал ?
	brne channal_check_2			; нет
	rjmp channal_1				; да




channal_check_2:				; проверка канала_2


	LDS Temp, ch_count			; читаем номер импульса


	cpi Temp, 2				; это 2-ой канал ?
	brne channal_check_sinhro		; нет
	rjmp channal_2				; да





channal_check_sinhro:				; синхроимпульс ( если это не канал, значит - синхроимпульс )			



	ldi Temp, 4				; если рассинхронизировалось, то ждем синхронизацию
	sts ch_count, Temp


	rjmp out_1				; выход







;*****************************************************************************************
; РАБОТА С КАНАЛАМИ
;*****************************************************************************************




channal_0:					; канал_0 ( газ )

	
	ldi Temp, 1				; следующим будет канал_1
	sts ch_count, Temp




	rjmp out_1				; выход									








;**********************************************************************************************



channal_1:					; канал_1 ( курс )




	ldi Temp, 2				; следующим будет канал_2
	sts ch_count, Temp




	rjmp out_1				; выход







;**********************************************************************************************

channal_2:					; канал_2 ( сервопривод тангажа )





	ldi Temp, 4				; следующим будет СИНХРОИМПУЛЬС
	sts ch_count, Temp


						 
;	OUT OCR1BH,XH				; зададим длину импульса
;	OUT OCR1BL,XL				; и выведем ее в порт сравнения




;*******************************************************************************
; вывод на диспдей
;*******************************************************************************



	rcall out_disp				; выводим на дисплей



	LDI R16,0x10				; печать пробела
	RCALL LCD_CHAR


	LDI R16,0				; печать нуля
	RCALL LCD_CHAR


	
cicle:

	rjmp cicle			; БЕСКОНЕЧНЫЙ ЦИКЛ








;**************************************************************************************************************
; Выход из прерывания
;**************************************************************************************************************

out_1:	

	

	pop temp4			; извлекаем "SREG" ////////////////////////////////////////////////////
	out SREG, temp4



	RETI				; точка выхода из прерывания




;**************************************************************************************************************
; подготовка информации для вывода на экран
;**************************************************************************************************************

out_disp:

	mov r16, XL			; берем младший байт TCNT1L
	push r16			; сохраняем его на стеке

	mov r16, XH			; берем старший байт TCNT1H
	rcall printhex			; переходим печатать старший байт

	pop r16				; извлекаем стек



printhex:

	push r16			; сохраняем на стеке
	swap r16			; меняем местами старший полубайт и младший полубайт (SWAP - поменять нибблы местами)

	rcall printhex1			; переходим на маску печати
	pop  r16			; берем данные из стека


printhex1:				; маска печати

	andi r16, 0x0f			; маска 00001111 (печатаем младший полубайт) 
	rcall lcd_char			; переходим на печать цифры
	ret 
	

;*****************************************************************************************
; подпрограмма сравнения 
;*****************************************************************************************


compare_XY16:

	cp Temp,YH			; сравниваем старшие части регистров
	breq xh_eq_yh			; значения старших регистров равны, нужно сравнить младшие xl и yl
					; флаг С - установлен когда X<Y
					; флаг С - сброшен когда X>Y
	ret



xh_eq_yh:

	cp Temp1,YL			; сравниваем младшие части регистров
					; флаг Z=1 когда X=Y
					; флаг С - установлен когда X<Y
					; флаг С - сброшен когда X>Y

	ret                            





;**************************************************************************************************************
; подключаемые модули
;**************************************************************************************************************

 .include "lcd5110mini.asm"		; подключение драйвера дисплея