xref: /plan9/sys/src/libmp/port/mpright.c (revision dc5a79c1208f0704eeb474acc990728f8b4854f5)
17dd7cddfSDavid du Colombier #include "os.h"
27dd7cddfSDavid du Colombier #include <mp.h>
37dd7cddfSDavid du Colombier #include "dat.h"
47dd7cddfSDavid du Colombier 
57dd7cddfSDavid du Colombier // res = b >> shift
67dd7cddfSDavid du Colombier void
mpright(mpint * b,int shift,mpint * res)77dd7cddfSDavid du Colombier mpright(mpint *b, int shift, mpint *res)
87dd7cddfSDavid du Colombier {
97dd7cddfSDavid du Colombier 	int d, l, r, i;
107dd7cddfSDavid du Colombier 	mpdigit this, last;
117dd7cddfSDavid du Colombier 
12*dc5a79c1SDavid du Colombier 	res->sign = b->sign;
13*dc5a79c1SDavid du Colombier 	if(b->top==0){
14*dc5a79c1SDavid du Colombier 		res->top = 0;
15*dc5a79c1SDavid du Colombier 		return;
16*dc5a79c1SDavid du Colombier 	}
17*dc5a79c1SDavid du Colombier 
187dd7cddfSDavid du Colombier 	// a negative right shift is a left shift
197dd7cddfSDavid du Colombier 	if(shift < 0){
207dd7cddfSDavid du Colombier 		mpleft(b, -shift, res);
217dd7cddfSDavid du Colombier 		return;
227dd7cddfSDavid du Colombier 	}
237dd7cddfSDavid du Colombier 
247dd7cddfSDavid du Colombier 	if(res != b)
257dd7cddfSDavid du Colombier 		mpbits(res, b->top*Dbits - shift);
267dd7cddfSDavid du Colombier 	d = shift/Dbits;
277dd7cddfSDavid du Colombier 	r = shift - d*Dbits;
287dd7cddfSDavid du Colombier 	l = Dbits - r;
297dd7cddfSDavid du Colombier 
30*dc5a79c1SDavid du Colombier 	//  shift all the bits out == zero
31*dc5a79c1SDavid du Colombier 	if(d>=b->top){
32*dc5a79c1SDavid du Colombier 		res->top = 0;
33*dc5a79c1SDavid du Colombier 		return;
34*dc5a79c1SDavid du Colombier 	}
35*dc5a79c1SDavid du Colombier 
367dd7cddfSDavid du Colombier 	// special case digit shifts
377dd7cddfSDavid du Colombier 	if(r == 0){
387dd7cddfSDavid du Colombier 		for(i = 0; i < b->top-d; i++)
397dd7cddfSDavid du Colombier 			res->p[i] = b->p[i+d];
407dd7cddfSDavid du Colombier 	} else {
417dd7cddfSDavid du Colombier 		last = b->p[d];
427dd7cddfSDavid du Colombier 		for(i = 0; i < b->top-d-1; i++){
437dd7cddfSDavid du Colombier 			this = b->p[i+d+1];
447dd7cddfSDavid du Colombier 			res->p[i] = (this<<l) | (last>>r);
457dd7cddfSDavid du Colombier 			last = this;
467dd7cddfSDavid du Colombier 		}
477dd7cddfSDavid du Colombier 		res->p[i++] = last>>r;
487dd7cddfSDavid du Colombier 	}
497dd7cddfSDavid du Colombier 	while(i > 0 && res->p[i-1] == 0)
507dd7cddfSDavid du Colombier 		i--;
517dd7cddfSDavid du Colombier 	res->top = i;
52*dc5a79c1SDavid du Colombier 	if(i==0)
53*dc5a79c1SDavid du Colombier 		res->sign = 1;
547dd7cddfSDavid du Colombier }
55