14e07dba7SMichal Simek#include <linux/linkage.h> 24e07dba7SMichal Simek 34e07dba7SMichal Simek/* 44e07dba7SMichal Simek* modulo operation for 32 bit integers. 54e07dba7SMichal Simek* Input : op1 in Reg r5 64e07dba7SMichal Simek* op2 in Reg r6 74e07dba7SMichal Simek* Output: op1 mod op2 in Reg r3 84e07dba7SMichal Simek*/ 94e07dba7SMichal Simek 104e07dba7SMichal Simek .text 114e07dba7SMichal Simek .globl __modsi3 124e07dba7SMichal Simek .type __modsi3, @function 134e07dba7SMichal Simek .ent __modsi3 144e07dba7SMichal Simek 154e07dba7SMichal Simek__modsi3: 164e07dba7SMichal Simek .frame r1, 0, r15 174e07dba7SMichal Simek 184e07dba7SMichal Simek addik r1, r1, -16 194e07dba7SMichal Simek swi r28, r1, 0 204e07dba7SMichal Simek swi r29, r1, 4 214e07dba7SMichal Simek swi r30, r1, 8 224e07dba7SMichal Simek swi r31, r1, 12 234e07dba7SMichal Simek 244e07dba7SMichal Simek beqi r6, div_by_zero /* div_by_zero division error */ 254e07dba7SMichal Simek beqi r5, result_is_zero /* result is zero */ 264e07dba7SMichal Simek bgeid r5, r5_pos 274e07dba7SMichal Simek /* get the sign of the result [ depends only on the first arg] */ 284e07dba7SMichal Simek add r28, r5, r0 294e07dba7SMichal Simek rsubi r5, r5, 0 /* make r5 positive */ 304e07dba7SMichal Simekr5_pos: 314e07dba7SMichal Simek bgei r6, r6_pos 324e07dba7SMichal Simek rsubi r6, r6, 0 /* make r6 positive */ 334e07dba7SMichal Simekr6_pos: 344e07dba7SMichal Simek addik r3, r0, 0 /* clear mod */ 354e07dba7SMichal Simek addik r30, r0, 0 /* clear div */ 364e07dba7SMichal Simek addik r29, r0, 32 /* initialize the loop count */ 374e07dba7SMichal Simek/* first part try to find the first '1' in the r5 */ 384e07dba7SMichal Simekdiv1: 394e07dba7SMichal Simek add r5, r5, r5 /* left shift logical r5 */ 404e07dba7SMichal Simek bgeid r5, div1 414e07dba7SMichal Simek addik r29, r29, -1 424e07dba7SMichal Simekdiv2: 434e07dba7SMichal Simek /* left shift logical r5 get the '1' into the carry */ 444e07dba7SMichal Simek add r5, r5, r5 454e07dba7SMichal Simek addc r3, r3, r3 /* move that bit into the mod register */ 464e07dba7SMichal Simek rsub r31, r6, r3 /* try to subtract (r30 a r6) */ 474e07dba7SMichal Simek blti r31, mod_too_small 484e07dba7SMichal Simek /* move the r31 to mod since the result was positive */ 494e07dba7SMichal Simek or r3, r0, r31 504e07dba7SMichal Simek addik r30, r30, 1 514e07dba7SMichal Simekmod_too_small: 524e07dba7SMichal Simek addik r29, r29, -1 534e07dba7SMichal Simek beqi r29, loop_end 544e07dba7SMichal Simek add r30, r30, r30 /* shift in the '1' into div */ 554e07dba7SMichal Simek bri div2 /* div2 */ 564e07dba7SMichal Simekloop_end: 574e07dba7SMichal Simek bgei r28, return_here 584e07dba7SMichal Simek brid return_here 594e07dba7SMichal Simek rsubi r3, r3, 0 /* negate the result */ 604e07dba7SMichal Simekdiv_by_zero: 614e07dba7SMichal Simekresult_is_zero: 624e07dba7SMichal Simek or r3, r0, r0 /* set result to 0 [both mod as well as div are 0] */ 634e07dba7SMichal Simekreturn_here: 644e07dba7SMichal Simek/* restore values of csrs and that of r3 and the divisor and the dividend */ 654e07dba7SMichal Simek lwi r28, r1, 0 664e07dba7SMichal Simek lwi r29, r1, 4 674e07dba7SMichal Simek lwi r30, r1, 8 684e07dba7SMichal Simek lwi r31, r1, 12 694e07dba7SMichal Simek rtsd r15, 8 704e07dba7SMichal Simek addik r1, r1, 16 714e07dba7SMichal Simek 724e07dba7SMichal Simek.size __modsi3, . - __modsi3 734e07dba7SMichal Simek.end __modsi3 74