Add [bootloader_zevero_sd_m1284p_make] bootloader prj
This commit is contained in:
maxxir_w
271
bootloader_zevero_sd_m1284p_make/asmfunc.S
Normal file
271
bootloader_zevero_sd_m1284p_make/asmfunc.S
Normal file
@@ -0,0 +1,271 @@
|
||||
;---------------------------------------------------------------------------;
|
||||
; MMC hardware controls and Flash controls (C)ChaN, 2010
|
||||
;---------------------------------------------------------------------------;
|
||||
; Hardware dependent macros to be modified //do this in Makefile
|
||||
#include "spi_pins.h"
|
||||
|
||||
; ALL Pins given as Port (A,B,C,...) plus number
|
||||
|
||||
; LED Pins
|
||||
;#define DDR_SS _SFR_IO_ADDR(DDRD), 5 // SS pin (PIN, PORT)
|
||||
;#define PORT_SS _SFR_IO_ADDR(PORTD), 5
|
||||
#define DDR_SS _SFR_IO_ADDR(DDRC), 3 // SS pin (PIN, PORT)
|
||||
#define PORT_SS _SFR_IO_ADDR(PORTC), 3
|
||||
|
||||
;#define DDR_PW _SFR_IO_ADDR(DDRD), 6 // Power pin (PIN, PORT)
|
||||
;#define PORT_PW _SFR_IO_ADDR(PORTD), 6
|
||||
|
||||
;SD CARD PINS
|
||||
#define DDR_CS _SFR_IO_ADDR(SD_CS_DDR), SD_CS_BIT
|
||||
#define PORT_CS _SFR_IO_ADDR(SD_CS_PORT), SD_CS_BIT
|
||||
|
||||
;---------------------------------------------------------------------------;
|
||||
.nolist
|
||||
#include <avr/io.h>
|
||||
.list
|
||||
.text
|
||||
|
||||
.global init_leds
|
||||
.func init_leds
|
||||
init_leds:
|
||||
sbi DDR_SS
|
||||
; sbi DDR_PW
|
||||
ret
|
||||
.endfunc
|
||||
|
||||
|
||||
.global led_write_on
|
||||
.func led_write_on
|
||||
led_write_on:
|
||||
sbi PORT_SS
|
||||
ret
|
||||
.endfunc
|
||||
|
||||
.global led_write_off
|
||||
.func led_write_off
|
||||
led_write_off:
|
||||
cbi PORT_SS
|
||||
ret
|
||||
.endfunc
|
||||
|
||||
;.global led_power_on
|
||||
;.func led_power_on
|
||||
;led_power_on:
|
||||
; sbi PORT_PW
|
||||
; ret
|
||||
;.endfunc
|
||||
|
||||
;.;global led_power_off
|
||||
;.;func led_power_off
|
||||
;led_power_off:
|
||||
; cbi PORT_PW
|
||||
; ret
|
||||
;.endfunc
|
||||
|
||||
;.;global led_power_toggle
|
||||
;.func led_power_toggle
|
||||
;led_power_toggle:
|
||||
; sbis PORT_PW
|
||||
; jmp led_power_on
|
||||
; jmp led_power_off
|
||||
;.endfunc
|
||||
|
||||
.global led_write_toggle
|
||||
.func led_write_toggle
|
||||
led_write_toggle:
|
||||
sbis PORT_SS
|
||||
jmp led_write_on
|
||||
jmp led_write_off
|
||||
.endfunc
|
||||
|
||||
;---------------------------------------------------------------------------;
|
||||
; Initialize MMC port
|
||||
;
|
||||
; void init_spi (void);
|
||||
|
||||
.global init_spi
|
||||
.func init_spi
|
||||
init_spi:
|
||||
sbi DDR_CS ; CS: output
|
||||
sbi DDR_DI ; DI: output
|
||||
sbi DDR_CK ; SCLK: output
|
||||
sbi PORT_DO ; DO: pull-up
|
||||
ret
|
||||
.endfunc
|
||||
|
||||
|
||||
|
||||
;---------------------------------------------------------------------------;
|
||||
; Delay 100 microseconds
|
||||
;
|
||||
; void dly_us (UINT n);
|
||||
|
||||
.global dly_100us
|
||||
.func dly_100us
|
||||
dly_100us:
|
||||
ldi r24, lo8(F_CPU / 100000) /* Loop counter */
|
||||
1: sbiw r30, 1 /* 10 clocks per loop */
|
||||
sbiw r30, 1
|
||||
sbiw r30, 1
|
||||
nop
|
||||
dec r24
|
||||
brne 1b
|
||||
ret
|
||||
.endfunc
|
||||
|
||||
|
||||
|
||||
;---------------------------------------------------------------------------;
|
||||
; Select MMC
|
||||
;
|
||||
; void select (void);
|
||||
|
||||
.global select
|
||||
.func select
|
||||
select:
|
||||
rcall deselect
|
||||
cbi PORT_CS
|
||||
rjmp rcv_spi
|
||||
.endfunc
|
||||
|
||||
|
||||
|
||||
;---------------------------------------------------------------------------;
|
||||
; Deselect MMC
|
||||
;
|
||||
; void deselect (void);
|
||||
|
||||
.global deselect
|
||||
.func deselect
|
||||
deselect:
|
||||
sbi PORT_CS
|
||||
; Goto next function
|
||||
.endfunc
|
||||
|
||||
|
||||
|
||||
;---------------------------------------------------------------------------;
|
||||
; Receive a byte
|
||||
;
|
||||
; BYTE rcv_spi (void);
|
||||
|
||||
.global rcv_spi
|
||||
.func rcv_spi
|
||||
rcv_spi:
|
||||
ldi r24, 0xFF ; Send 0xFF to receive data
|
||||
; Goto next function
|
||||
.endfunc
|
||||
|
||||
|
||||
|
||||
;---------------------------------------------------------------------------;
|
||||
; Transmit a byte
|
||||
;
|
||||
; void xmit_spi (BYTE);
|
||||
|
||||
.global xmit_spi
|
||||
.func xmit_spi
|
||||
xmit_spi:
|
||||
ldi r25, 8
|
||||
1: sbrc r24, 7 ; DI = Bit to sent
|
||||
sbi PORT_DI ;
|
||||
sbrs r24, 7 ;
|
||||
cbi PORT_DI ; /
|
||||
lsl r24 ; Get DO from MMC
|
||||
sbic PIN_DO ;
|
||||
inc r24 ; /
|
||||
sbi PORT_CK ; A positive pulse to SCLK
|
||||
cbi PORT_CK ; /
|
||||
dec r25 ; Repeat 8 times
|
||||
brne 1b ; /
|
||||
ret
|
||||
.endfunc
|
||||
|
||||
|
||||
|
||||
;---------------------------------------------------------------------------
|
||||
; Erase a flash page
|
||||
;
|
||||
; void flash_erase (DWORD flash_addr);
|
||||
|
||||
#ifndef SPMCSR
|
||||
#define SPMCSR SPMCR
|
||||
#endif
|
||||
|
||||
.global flash_erase
|
||||
.func flash_erase
|
||||
flash_erase:
|
||||
|
||||
movw ZL, r22
|
||||
#if FLASHEND >= 0x10000
|
||||
out _SFR_IO_ADDR(RAMPZ), r24
|
||||
#endif
|
||||
|
||||
; Initiate erase operation
|
||||
ldi r24, 0b00000011
|
||||
sts _SFR_MEM_ADDR(SPMCSR), r24
|
||||
spm
|
||||
|
||||
; Wait for end of erase operation
|
||||
1: lds r24, _SFR_MEM_ADDR(SPMCSR)
|
||||
sbrc r24, 0
|
||||
rjmp 1b
|
||||
|
||||
; Re-enable read access to the flash
|
||||
ldi r24, 0b00010001
|
||||
sts _SFR_MEM_ADDR(SPMCSR), r24
|
||||
spm
|
||||
|
||||
9: ret
|
||||
.endfunc
|
||||
|
||||
|
||||
|
||||
;---------------------------------------------------------------------------
|
||||
; Write a flash page
|
||||
;
|
||||
; void flash_write (DWORD flash_addr, const BYTE* data);
|
||||
|
||||
.global flash_write
|
||||
.func flash_write
|
||||
flash_write:
|
||||
push r0
|
||||
push r1
|
||||
|
||||
#if FLASHEND >= 0x10000
|
||||
out _SFR_IO_ADDR(RAMPZ), r24
|
||||
#endif
|
||||
|
||||
; Fill page buffer
|
||||
movw ZL, r22
|
||||
movw XL, r20
|
||||
ldi r25, lo8(SPM_PAGESIZE/2)
|
||||
1: ld r0, X+
|
||||
ld r1, X+
|
||||
ldi r24, 0b00000001
|
||||
sts _SFR_MEM_ADDR(SPMCSR), r24
|
||||
spm
|
||||
adiw ZL, 2
|
||||
dec r25
|
||||
brne 1b
|
||||
|
||||
; Initiate write operation
|
||||
movw ZL, r22
|
||||
ldi r24, 0b00000101
|
||||
sts _SFR_MEM_ADDR(SPMCSR), r24
|
||||
spm
|
||||
|
||||
; Wait for end of write operation
|
||||
2: lds r24, _SFR_MEM_ADDR(SPMCSR)
|
||||
sbrc r24, 0
|
||||
rjmp 2b
|
||||
|
||||
; Re-enable read access to the flash
|
||||
ldi r24, 0b00010001
|
||||
sts _SFR_MEM_ADDR(SPMCSR), r24
|
||||
spm
|
||||
|
||||
9: pop r1
|
||||
pop r0
|
||||
ret
|
||||
.endfunc
|
||||
Reference in New Issue
Block a user