;-----------------------------------------------;

; SM - Get SM type and initialize SM properties

;

; Call: none

; Ret: C=0: successful, SmPages are valid

; C=1: unknown type

sm_gettype:

ldiw Y,SmSign ; Y = Pointer to SM property structure

cbi PORTC,CE ; CE="L"

sbi PORTC,CLE ; Command Phase: CLE="H", ALE="L"

cbi PORTC,ALE ; /

ldi r16,C_ID ; Cmd: Read ID

rcall sm_write ; /

cbi PORTC,CLE ; Address Phase: CLE="L", ALE="H"

sbi PORTC,ALE ; /

ldi r16,0x00 ; Addr: 0

rcall sm_write ; /

cbi PORTC,ALE ; Data Phase: CLE="L", ALE="L"

outi DDRA,0 ; Disable data out

outi PORTA,-1 ; Pull-up

rcall sm_read ; Read mfr code

st Y+,r16 ; /

rcall sm_read ; Read device code

st Y+,r16 ; /

sbi PORTC,CE ; CE = "H"

cpi r16,Sign8 ; Is device size 8MB ?

brne PC+8 ; no, skip

sti Y+,byte2(Pages8); Initialize as 8MB

sti Y+,byte3(Pages8);

sti Y+,Blkp8-1 ;

ret ; /

cpi r16,Sign16 ; Is device size 16MB ?

brne PC+8 ; no, skip

sti Y+,byte2(Pages16); Initialize as 16MB

sti Y+,byte3(Pages16);

sti Y+,Blkp16-1 ;

ret ; /

cpi r16,Sign32 ; Is device size 32MB ?

brne PC+8 ; no, skip

sti Y+,byte2(Pages32); Initialize as 32MB

sti Y+,byte3(Pages32);

sti Y+,Blkp32-1 ;

ret ; /

cpi r16,Sign64 ; Is device size 64MB ?

brne PC+8 ; no, skip

sti Y+,byte2(Pages64); Initialize as 64MB

sti Y+,byte3(Pages64);

sti Y+,Blkp64-1 ;

ret ; /

cpi r16,Sign128 ; Is device size 128MB ?

brne PC+8 ; no, skip

sti Y+,byte2(Pages128); Initialize as 128MB

sti Y+,byte3(Pages128);

sti Y+,Blkp128-1 ;

ret ; /

ret ; Unknown device type

;-----------------------------------------------;

; SM - Test and erase current block

;

; Call: _PageX = Page(block) to be checked

; Ret: r16,r17,r18,r19,_Loop = broken

; C=0 : Successful, Block is erased.

; C=1 : Bad block.

sm_chk_blk:

rcall sm_erase ; Erase

brcs sc_ret ; /

ldi r19,0x55 ; Write 0x55,0xAA....

rcall sc_fill ;

brcs sc_ret ; /

rcall sc_chk ; Verify

brcs sc_ret ; /

rcall sm_erase ; Erase

brcs sc_ret ; /

ldi r19,0xaa ; Write 0xAA,0x55....

rcall sc_fill ;

brcs sc_ret ; /

rcall sc_chk ; Verify

brcs sc_ret ; /

rcall sm_erase ; Erase

sc_ret: sbi PORTC,CE ; CE = "H"

ret

sc_fill:

push _PageL

push _PageM

push _PageH

lds _Loop,SmPPB ; Block count

inc _Loop ;

scf_sl: rcall sm_wr_set ;---- Block filling loop

ldi r18,512/2 ; Page count

out PORTA,r19 ;---- Page filling loop

cbi PORTC,WE ; Write Even byte

sbi PORTC,WE ; /

com r19 ; P = !P

out PORTA,r19 ; Write Odd byte

cbi PORTC,WE ;

sbi PORTC,WE ; /

com r19 ; P = !P

dec r18 ; End of page ?

brne PC-9 ; no, continue

rcall sm_wr_start ; Start to write

brcs scf_err ; /

rcall next_page ; Page ++

dec _Loop ; End of block ?

brne scf_sl ; no, continue

clc

rjmp PC+2

scf_err:sec

pop _PageH

pop _PageM

pop _PageL

ret

sc_chk:

push _PageL

push _PageM

push _PageH

lds _Loop,SmPPB ; Block count

inc _Loop ;

com r19 ; P = !P

scc_sl: rcall sm_rd_page ;---- Block compare loop

ldi r18,512/2 ; Page count

cbi PORTC,RE ;---- Page compare loop

com r19 ; P = !P

in r16,PINA ; Read Even byte

sbi PORTC,RE ; /

cp r16,r19 ;

brne scc_err ;

cbi PORTC,RE ; Read Odd byte

com r19 ; P = !P

in r16,PINA ;

sbi PORTC,RE ; /

cp r16,r19 ;

brne scc_err ;

dec r18 ; End of page ?

brne PC-13 ; no, continue

rcall next_page ; Page ++

dec _Loop ; End of block ?

brne scc_sl ; no, continue

clc

rjmp PC+2

scc_err:sec

pop _PageH

pop _PageM

pop _PageL

ret

;-----------------------------------------------;

; SM - Receive 512 bytes of page data from HOST into SM

;

; Call: none

; Ret: r16-r19 = broken

;

;SCK ______---___---___---___---______

;MOSI -----000111222333444555666777----

sm_rcv512:

ldi r18,low(511)

ldi r19,high(511)

rcv1: in r16,PINB ; b0

bst r16,SCK

brtc PC-2

bst r16,MOSI

bld r17,0

in r16,PINB ; b1

bst r16,SCK

brts PC-2

bst r16,MOSI

bld r17,1

in r16,PINB ; b2

bst r16,SCK

brtc PC-2

bst r16,MOSI

bld r17,2

in r16,PINB ; b3

bst r16,SCK

brts PC-2

bst r16,MOSI

bld r17,3

in r16,PINB ; b4

bst r16,SCK

brtc PC-2

bst r16,MOSI

bld r17,4

in r16,PINB ; b5

bst r16,SCK

brts PC-2

bst r16,MOSI

bld r17,5

in r16,PINB ; b6

bst r16,SCK

brtc PC-2

bst r16,MOSI

bld r17,6

in r16,PINB ; b7

bst r16,SCK

brts PC-2

bst r16,MOSI

bld r17,7

out PORTA,r17 ; Write into SM

cbi PORTC,WE ;

sbi PORTC,WE ; /

subi r18,1 ; End of page ?

sbci r19,0 ; no, continue

brcc rcv1 ; /

ret

;-----------------------------------------------;

; SM - Reset device

;

; Call: none

; Ret: r16 = broken

sm_reset:

cbi PORTC,CE ; CE="L"

sbi PORTC,CLE ; Command Phase: CLE="H", ALE="L"

cbi PORTC,ALE ; /

ldi r16,C_RES ; Cmd: Reset

rcall sm_write ; /

sbis PINC,BSY ; Wait for ready

rjmp PC-1 ; /

sbi PORTC,CE ; CE="H"

ret

;-----------------------------------------------;

; SM - Erase current block

;

; Call: _PageX = Page(Block) for erase

; Ret: r16 = broken

; C = 0:Successful, 1:error

sm_erase:

cbi PORTC,CE ; CE="L"

sbi PORTC,CLE ; Command Phase: CLE="H", ALE="L"

cbi PORTC,ALE ; /

ldi r16,C_ERA1 ; Cmd: Erase 1

rcall sm_write ; /

cbi PORTC,CLE ; Address Phase: CLE="L", ALE="H"

sbi PORTC,ALE ; /

mov r16,_PageL ; Addr 1

rcall sm_write ; /

mov r16,_PageM ; Addr 2

rcall sm_write ; /

mov r16,_PageH ; Addr 3 (will be ignored at 32M or below SMs)

rcall sm_write ; /

sbi PORTC,CLE ; Command Phase: CLE="H", ALE="L"

cbi PORTC,ALE ; /

ldi r16,C_ERA2 ; Cmd: Erase 2

rcall sm_write ; /

sbis PINC,BSY ; Wait for end of erase

rjmp PC-1 ; /

ldi r16,C_STA ; Cmd: Status

rcall sm_write ; /

cbi PORTC,CLE ; Data Phase: CLE="L", ALE="L"

rcall sm_read ; Read status into C

lsr r16 ; /

ret

;-----------------------------------------------;

; SM - Set ready to write

;

; Call: _PageX = Page for write

; Ret: r16 = broken

sm_wr_set:

cbi PORTC,CE ; CE="L"

sbi PORTC,CLE ; Command Phase: CLE="H", ALE="L"

cbi PORTC,ALE ; /

ldi r16,C_RD0 ; Cmd: Cancel RD2 cmd

rcall sm_write ; /

ldi r16,C_WR ; Cmd: Write set

rcall sm_write ; /

cbi PORTC,CLE ; Address Phase: CLE="L", ALE="H"

sbi PORTC,ALE ; /

ldi r16,0x00 ; Addr 0

rcall sm_write ; /

mov r16,_PageL ; Addr 1

rcall sm_write ; /

mov r16,_PageM ; Addr 2

rcall sm_write ; /

mov r16,_PageH ; Addr 3 (will be ignored at 32M/16M SMs)

rcall sm_write ; /

cbi PORTC,ALE ; Data Phase: CLE="L", ALE="L"

ret

;-----------------------------------------------;

; SM - Write intrenal buffer into memory array

;

; Call: none

; Ret: C=0 : Successful

; C=1 : Error

sm_wr_start:

sbi PORTC,CLE ; Command Phase: CLE="H", ALE="L"

cbi PORTC,ALE ; /

ldi r16,C_PRG ; Cmd: Write start

rcall sm_write ; /

sbis PINC,BSY ; Wait for ready

rjmp PC-1 ; /

ldi r16,C_STA ; Cmd: Read status

rcall sm_write ; /

cbi PORTC,CLE ; Data Phase: CLE="L", ALE="L"

rcall sm_read ; Read data

sbi PORTC,CE ; CE = "H"

lsr r16 ; Read status into C

ret

;-----------------------------------------------;

; SM - Read out a page data from memory array

; into transfer buffer

;

; Call: _PageX = Page# for read

; Ret: r16 = broken

;

; NOTE1: AT 32MB MEDIUM OR BELOW.

; The read transfer cycle is initiated after Addr2, following Addr3 will

; be ignored. But if Addr3 is given at the read transfer cycle has been

; completed, read data can become wrong. An interrupt between Addr2 and

; Addr3 will cause this problem. Therefore, all interrupts must be disabled

; during this routine is executed in order to avoid data collaption.

; NOTE2: Above problem has been fixed at this routine :-)

sm_rd_page2: ; Read a page and set pointer to offset 512

ldi r16,C_RD2 ; Cmd: Read2

rjmp PC+2 ;

sm_rd_page: ; Read a page and set pointer to offset 0

ldi r16,C_RD0 ; Cmd: Read

in _SrgTmp2,SREG ; Save I flag

cli ; Disable interrupts (TO AVOID DATA COLLAPTION)

cbi PORTC,CE ; CE="L"

sbi PORTC,CLE ; Command Phase: CLE="H", ALE="L"

cbi PORTC,ALE ; /

rcall sm_write ; Command

cbi PORTC,CLE ; Address Phase: CLE="L", ALE="H"

sbi PORTC,ALE ; /

ldi r16,0x00 ; Addr 0

rcall sm_write ; /

mov r16,_PageL ; Addr 1

rcall sm_write ; /

mov r16,_PageM ; Addr 2

rcall sm_write ; /

mov r16,_PageH ; Addr 3 (will be ignored at < 64M media)

rcall sm_write ; /

cbi PORTC,ALE ; Data Phase: CLE="L", ALE="L"

outi DDRA,0x00 ; Disable data out

outi PORTA,-1 ; Pull-up

out SREG,_SrgTmp2 ; Restore I flag

sbis PINC,BSY ; Wait for ready

rjmp PC-1 ; /

ret

;-----------------------------------------------;

; SM - Read/Write byte

;

; Call: r16 = data for write

; Ret: r16 = read data

sm_write:

out PORTA,r16 ; Set data for write

outi DDRA,0xff ; Enable data out

cbi PORTC,WE ; WE="L"

sbi PORTC,WE ; WE="H"

ret

sm_read:

cbi PORTC,RE ; RE="L"

nop ;

in r16,PINA ; Read

sbi PORTC,RE ; RE="H"

ret