checksumcopy.S
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:3k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /* $Id: checksumcopy.S,v 1.7 2001/10/01 14:47:35 bjornw Exp $
  2.  * A fast checksum+copy routine using movem
  3.  * Copyright (c) 1998, 2001 Axis Communications AB
  4.  *
  5.  * Authors: Bjorn Wesen
  6.  * 
  7.  * csum_partial_copy_nocheck(const char *src, char *dst,
  8.  *              int len, unsigned int sum)
  9.  */
  10. .globl csum_partial_copy_nocheck
  11. csum_partial_copy_nocheck:
  12. ;; r10 - src
  13. ;; r11 - dst
  14. ;; r12 - length
  15. ;; r13 - checksum
  16. ;; check for breakeven length between movem and normal word looping versions
  17. ;; we also do _NOT_ want to compute a checksum over more than the 
  18. ;; actual length when length < 40
  19. cmpu.w 80, $r12
  20. blo _word_loop
  21. nop
  22. ;; need to save the registers we use below in the movem loop
  23. ;; this overhead is why we have a check above for breakeven length
  24. ;; only r0 - r8 have to be saved, the other ones are clobber-able
  25. ;; according to the ABI
  26. subq 9*4, $sp
  27. movem $r8, [$sp]
  28. ;; do a movem copy and checksum
  29. subq 10*4, $r12 ; update length for the first loop
  30. _mloop: movem [$r10+],$r9 ; read 10 longwords
  31. 1: ;; A failing userspace access will have this as PC.
  32. movem $r9,[$r11+] ; write 10 longwords
  33. ;; perform dword checksumming on the 10 longwords
  34. add.d $r0,$r13
  35. ax
  36. add.d $r1,$r13
  37. ax
  38. add.d $r2,$r13
  39. ax
  40. add.d $r3,$r13
  41. ax
  42. add.d $r4,$r13
  43. ax
  44. add.d $r5,$r13
  45. ax
  46. add.d $r6,$r13
  47. ax
  48. add.d $r7,$r13
  49. ax
  50. add.d $r8,$r13
  51. ax
  52. add.d $r9,$r13
  53. ;; fold the carry into the checksum, to avoid having to loop the carry
  54. ;; back into the top
  55. ax
  56. addq 0,$r13
  57. ax ; do it again, since we might have generated a carry
  58. addq 0,$r13
  59. subq 10*4,$r12
  60. bge _mloop
  61. nop
  62. addq 10*4,$r12 ; compensate for last loop underflowing length
  63. movem [$sp+],$r8 ; restore regs
  64. _word_loop:
  65. ;; only fold if there is anything to fold.
  66. cmpq 0,$r13
  67. beq _no_fold
  68. ;; fold 32-bit checksum into a 16-bit checksum, to avoid carries below
  69. ;; r9 can be used as temporary.
  70. move.d $r13,$r9
  71. lsrq 16,$r9 ; r0 = checksum >> 16
  72. and.d 0xffff,$r13 ; checksum = checksum & 0xffff
  73. add.d $r9,$r13 ; checksum += r0
  74. move.d $r13,$r9 ; do the same again, maybe we got a carry last add
  75. lsrq 16,$r9
  76. and.d 0xffff,$r13
  77. add.d $r9,$r13
  78. _no_fold:
  79. cmpq 2,$r12
  80. blt _no_words
  81. nop
  82. ;; copy and checksum the rest of the words
  83. subq 2,$r12
  84. _wloop: move.w [$r10+],$r9
  85. 2: ;; A failing userspace access will have this as PC.
  86. addu.w $r9,$r13
  87. subq 2,$r12
  88. bge _wloop
  89. move.w $r9,[$r11+]
  90. addq 2,$r12
  91. _no_words:
  92. ;; see if we have one odd byte more
  93. cmpq 1,$r12
  94. beq _do_byte
  95. nop
  96. ret
  97. move.d $r13, $r10
  98. _do_byte:
  99. ;; copy and checksum the last byte
  100. move.b [$r10],$r9
  101. 3: ;; A failing userspace access will have this as PC.
  102. addu.b $r9,$r13
  103. move.b $r9,[$r11]
  104. ret
  105. move.d $r13, $r10