divsi3.S 1.7 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374
  1. /* SPDX-License-Identifier: GPL-2.0 */
  2. #include <linux/linkage.h>
  3. /*
  4. * Divide operation for 32 bit integers.
  5. * Input : Dividend in Reg r5
  6. * Divisor in Reg r6
  7. * Output: Result in Reg r3
  8. */
  9. .text
  10. .globl __divsi3
  11. .type __divsi3, @function
  12. .ent __divsi3
  13. __divsi3:
  14. .frame r1, 0, r15
  15. addik r1, r1, -16
  16. swi r28, r1, 0
  17. swi r29, r1, 4
  18. swi r30, r1, 8
  19. swi r31, r1, 12
  20. beqi r6, div_by_zero /* div_by_zero - division error */
  21. beqi r5, result_is_zero /* result is zero */
  22. bgeid r5, r5_pos
  23. xor r28, r5, r6 /* get the sign of the result */
  24. rsubi r5, r5, 0 /* make r5 positive */
  25. r5_pos:
  26. bgei r6, r6_pos
  27. rsubi r6, r6, 0 /* make r6 positive */
  28. r6_pos:
  29. addik r30, r0, 0 /* clear mod */
  30. addik r3, r0, 0 /* clear div */
  31. addik r29, r0, 32 /* initialize the loop count */
  32. /* first part try to find the first '1' in the r5 */
  33. div0:
  34. blti r5, div2 /* this traps r5 == 0x80000000 */
  35. div1:
  36. add r5, r5, r5 /* left shift logical r5 */
  37. bgtid r5, div1
  38. addik r29, r29, -1
  39. div2:
  40. /* left shift logical r5 get the '1' into the carry */
  41. add r5, r5, r5
  42. addc r30, r30, r30 /* move that bit into the mod register */
  43. rsub r31, r6, r30 /* try to subtract (r30 a r6) */
  44. blti r31, mod_too_small
  45. /* move the r31 to mod since the result was positive */
  46. or r30, r0, r31
  47. addik r3, r3, 1
  48. mod_too_small:
  49. addik r29, r29, -1
  50. beqi r29, loop_end
  51. add r3, r3, r3 /* shift in the '1' into div */
  52. bri div2 /* div2 */
  53. loop_end:
  54. bgei r28, return_here
  55. brid return_here
  56. rsubi r3, r3, 0 /* negate the result */
  57. div_by_zero:
  58. result_is_zero:
  59. or r3, r0, r0 /* set result to 0 */
  60. return_here:
  61. /* restore values of csrs and that of r3 and the divisor and the dividend */
  62. lwi r28, r1, 0
  63. lwi r29, r1, 4
  64. lwi r30, r1, 8
  65. lwi r31, r1, 12
  66. rtsd r15, 8
  67. addik r1, r1, 16
  68. .size __divsi3, . - __divsi3
  69. .end __divsi3