| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172 |
- ;Incs and Defs---------------------------------------------------------
- .include "atm328p.inc"
- .include "global.inc"
- ;++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
- ;Main Programm
- .global main
- main:
- ldi main_r, lo8(RAMEND) ;Stackpointer
- out SPL, main_r
- ldi main_r, hi8(RAMEND)
- out SPH, main_r
- clr false ;set Registers
- ser true
- call usart_init; ;init USART
- ldi main_r, (1<<PC0)|(1<<PC1)|(1<<PC2)|(1<<PC3)|(1<<PC4)
- out DDRC, main_r ;init I/O
- out PORTC, false
- sei ;enable Interrupts
- rjmp mode_select ;select Mode
- rjmp .-2 ;Endlosschleife
- cli ;disable Interrupts
- ;++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
- ;Mode Selection
- mode_select:
- in main_r, PORTC ;toggle PC0
- ldi usart_r, 1<<PC0
- eor main_r, usart_r
- out PORTC, main_r
- ;Receive Frame----------------------------------------------------------
- ldi X_l, lo8(cmd_ptr) ;set Command-Ptr
- ldi X_h, hi8(cmd_ptr)
- lds usart_r, UCSR0B ;activate Receiver
- sbr usart_r, (1<<RXEN0)|(1<<RXCIE0)
- sts UCSR0B, usart_r
- lds usart_r, frame_cnt
- cpi usart_r, 0x03 ;check if Frame rec
- brne .-8
- lds usart_r, UCSR0B ;disable Receiver
- cbr usart_r, (1<<RXEN0)|(1<<RXCIE0)
- sts UCSR0B, usart_r
- sts UDR0, false ;clear UDR
- sts frame_cnt, false ;reset Frame cnt
- call cmd_rebuild ;read Cmd
- ;Select Mode------------------------------------------------------------
- sbrc mode, fuse_read
- rjmp mode_select
- sbrc mode, fuse_write
- rjmp mode_select
- sbrc mode, page_read
- call mode_page_read
- sbrc mode, page_write
- rjmp mode_select
- sbrc mode, prog_read
- rjmp mode_select
- ;Send Frame-------------------------------------------------------------
- ldi X_l, lo8(cmd_ptr) ;set Command-Ptr
- ldi X_h, hi8(cmd_ptr)
- lds usart_r, UCSR0B ;enable UDRI
- sbr usart_r, 1<<UDRIE0
- sts UCSR0B, usart_r
- lds usart_r, frame_cnt
- cpi usart_r, 0x04 ;check if Frame send
- brne .-8
- lds usart_r, UCSR0B ;disable TX, TXCI
- cbr usart_r, (1<<TXEN0)|(1<<TXCIE0)|(1<<UDRIE0)
- sts UCSR0B, usart_r
- sts UDR0, false ;clear UDR
- sts frame_cnt, false ;reset Frame cnt
- sbi PORTC, PC1 ;read Page complete
- rjmp mode_select
- ;++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
- ;Cmd rebuild
- cmd_rebuild:
- lds main_r, cmd_mode ;set Mode
- andi main_r, nibble_lo
- ldi mode, 0x01
- tst main_r
- breq .+6
- lsl mode
- dec main_r
- rjmp .-10
- clr option ;set Option
- lds main_r, cmd_opt_lo
- andi main_r, nibble_lo
- or option, main_r
- lds main_r, cmd_opt_hi
- andi main_r, nibble_lo
- swap main_r
- or option, main_r
- brne .+4 ;check valid Mode
- jmp mode_select
- ret
- ;++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
- ;Read Page
- mode_page_read:
- ;Send Acknoledgement---------------------------------------------------
- sts cmd_mode, option ;verify Mode
- sts cmd_opt_lo, option
- sts cmd_opt_hi, option
- ldi X_l, lo8(cmd_ptr) ;set Command-Ptr
- ldi X_h, hi8(cmd_ptr)
- lds usart_r, UCSR0B ;enable UDRI
- sbr usart_r, 1<<UDRIE0
- sts UCSR0B, usart_r
- lds usart_r, frame_cnt
- cpi usart_r, 0x04 ;check if Frame send
- brne .-8
- lds usart_r, UCSR0B ;disable TX, TXCI
- cbr usart_r, (1<<TXEN0)|(1<<TXCIE0)|(1<<UDRIE0)
- sts UCSR0B, usart_r
- sts UDR0, false ;clear UDR
- sts frame_cnt, false ;reset Frame cnt
- ;Read Page--------------------------------------------------------------
- ldi X_l, lo8(page_ptr) ;set Page-Ptr
- ldi X_h, hi8(page_ptr)
- lds usart_r, UCSR0B ;activate Receiver
- sbr usart_r, (1<<RXEN0)|(1<<RXCIE0)
- sts UCSR0B, usart_r
- lds usart_r, frame_cnt
- cp usart_r, option ;check if Page rec
- brne .-8
- lds usart_r, UCSR0B ;disable Receiver
- cbr usart_r, (1<<RXEN0)|(1<<RXCIE0)
- sts UCSR0B, usart_r
- sts UDR0, false ;clear UDR
- sts frame_cnt, false ;reset Frame cnt
- ldi main_r, frame_mask ;signal Page rec
- sts cmd_mode, main_r
- sts cmd_opt_lo, main_r
- sts cmd_opt_hi, main_r
- ret
|
