mirror of
git://git.code.sf.net/p/openocd/code
synced 2025-07-20 03:54:05 +10:00
9de7d9c81d
Change-Id: I21126945c0475399aaf12239b8972fde5fddd845 Signed-off-by: Ake Rehnman <ake.rehnman@gmail.com> Reviewed-on: http://openocd.zylin.com/5331 Tested-by: jenkins Reviewed-by: Antonio Borneo <borneo.antonio@gmail.com> Reviewed-by: Tomas Vanek <vanekt@fbl.cz> Reviewed-by: Tarek BOCHKATI <tarek.bouchkati@gmail.com>
70 lines
1.6 KiB
ArmAsm
70 lines
1.6 KiB
ArmAsm
/*
|
|
* Copyright (C) 2017 Ake Rehnman
|
|
* ake.rehnman(at)gmail.com
|
|
*
|
|
* This program is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation, either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
;;
|
|
;; erase check memory code
|
|
;;
|
|
.org 0x0
|
|
;; start address
|
|
start_addr: .byte 0x00
|
|
.word 0x8000
|
|
;; byte count
|
|
byte_cnt: .byte 0x00
|
|
.word 0x8000
|
|
;
|
|
; SP must point to start_addr on entry
|
|
; first relocate start_addr to the location
|
|
; we are running at
|
|
start:
|
|
ldw X,SP
|
|
ldw .cont+2,X
|
|
ldw X,(start_addr+1,SP) ;start addr
|
|
ldw Y,(byte_cnt+1,SP) ;count
|
|
ld A,#0xff
|
|
;
|
|
; if count == 0 return
|
|
.L1:
|
|
tnzw Y
|
|
jrne .decrcnt ;continue if low word != 0
|
|
tnz (byte_cnt,SP) ;high byte
|
|
jreq .exit ;goto exit
|
|
;
|
|
; decrement count (byte_cnt)
|
|
.decrcnt:
|
|
tnzw Y ;low word count
|
|
jrne .decr1
|
|
dec (byte_cnt,SP) ;high byte
|
|
.decr1:
|
|
decw Y; decr low word
|
|
;
|
|
; first check if [start_addr] is 0xff
|
|
.cont:
|
|
ldf A, [start_addr.e]
|
|
cp A,#0xff
|
|
jrne .exit ;exit if not 0xff
|
|
;
|
|
; increment start_addr (addr)
|
|
incw X
|
|
jrne .L1
|
|
inc (start_addr,SP) ;increment high byte
|
|
jra .L1
|
|
;
|
|
.exit:
|
|
ldw (start_addr+1,SP),X ;start addr
|
|
ldw (byte_cnt+1,SP),Y ;count
|
|
break
|