95 lines
2.1 KiB
ArmAsm
95 lines
2.1 KiB
ArmAsm
|
/*
|
||
|
|
* A fast checksum+copy routine using movem
|
||
|
|
* Copyright (c) 1998-2007 Axis Communications AB
|
||
|
|
*
|
||
|
|
* Authors: Bjorn Wesen
|
||
|
|
*
|
||
|
|
* csum_partial_copy_nocheck(const char *src, char *dst,
|
||
|
|
* int len, unsigned int sum)
|
||
|
|
*/
|
||
|
|
|
||
|
|
.globl csum_partial_copy_nocheck
|
||
|
|
.type csum_partial_copy_nocheck,@function
|
||
|
|
csum_partial_copy_nocheck:
|
||
|
|
|
||
|
|
;; r10 - src
|
||
|
|
;; r11 - dst
|
||
|
|
;; r12 - length
|
||
|
|
;; r13 - checksum
|
||
|
|
|
||
|
|
;; Optimized for large packets
|
||
|
|
subq 10*4, $r12
|
||
|
|
blt _word_loop
|
||
|
|
move.d $r12, $acr
|
||
|
|
|
||
|
|
subq 9*4,$sp
|
||
|
|
clearf c
|
||
|
|
movem $r8,[$sp]
|
||
|
|
|
||
|
|
;; do a movem copy and checksum
|
||
|
|
1: ;; A failing userspace access (the read) will have this as PC.
|
||
|
|
_mloop: movem [$r10+],$r9 ; read 10 longwords
|
||
|
|
addoq -10*4, $acr, $acr ; loop counter in latency cycle
|
||
|
|
movem $r9,[$r11+] ; write 10 longwords
|
||
|
|
|
||
|
|
;; perform dword checksumming on the 10 longwords
|
||
|
|
addc $r0,$r13
|
||
|
|
addc $r1,$r13
|
||
|
|
addc $r2,$r13
|
||
|
|
addc $r3,$r13
|
||
|
|
addc $r4,$r13
|
||
|
|
addc $r5,$r13
|
||
|
|
addc $r6,$r13
|
||
|
|
addc $r7,$r13
|
||
|
|
addc $r8,$r13
|
||
|
|
addc $r9,$r13
|
||
|
|
|
||
|
|
;; test $acr, without trashing carry.
|
||
|
|
move.d $acr, $acr
|
||
|
|
bpl _mloop
|
||
|
|
;; r12 <= acr is needed after mloop and in the exception handlers.
|
||
|
|
move.d $acr, $r12
|
||
|
|
|
||
|
|
;; fold the last carry into r13
|
||
|
|
addc 0, $r13
|
||
|
|
movem [$sp+],$r8 ; restore regs
|
||
|
|
|
||
|
|
_word_loop:
|
||
|
|
addq 10*4,$r12 ; compensate for last loop underflowing length
|
||
|
|
|
||
|
|
;; fold 32-bit checksum into a 16-bit checksum, to avoid carries below
|
||
|
|
;; r9 can be used as temporary.
|
||
|
|
move.d $r13,$r9
|
||
|
|
lsrq 16,$r9 ; r0 = checksum >> 16
|
||
|
|
and.d 0xffff,$r13 ; checksum = checksum & 0xffff
|
||
|
|
|
||
|
|
subq 2, $r12
|
||
|
|
blt _no_words
|
||
|
|
add.d $r9,$r13 ; checksum += r0
|
||
|
|
|
||
|
|
;; copy and checksum the rest of the words
|
||
|
|
2: ;; A failing userspace access for the read below will have this as PC.
|
||
|
|
_wloop: move.w [$r10+],$r9
|
||
|
|
addu.w $r9,$r13
|
||
|
|
subq 2,$r12
|
||
|
|
bge _wloop
|
||
|
|
move.w $r9,[$r11+]
|
||
|
|
|
||
|
|
_no_words:
|
||
|
|
addq 2,$r12
|
||
|
|
bne _do_byte
|
||
|
|
nop
|
||
|
|
ret
|
||
|
|
move.d $r13,$r10
|
||
|
|
|
||
|
|
_do_byte:
|
||
|
|
;; copy and checksum the last byte
|
||
|
|
3: ;; A failing userspace access for the read below will have this as PC.
|
||
|
|
move.b [$r10],$r9
|
||
|
|
addu.b $r9,$r13
|
||
|
|
move.b $r9,[$r11]
|
||
|
|
ret
|
||
|
|
move.d $r13,$r10
|
||
|
|
|
||
|
|
.size csum_partial_copy_nocheck, . - csum_partial_copy_nocheck
|