758 |
|
int |
759 |
|
rmx_transpose(RMATRIX *rm) |
760 |
|
{ |
761 |
– |
#define bmbyte(r,c) bmap[((r)*rm->ncols+(c))>>3] |
762 |
– |
#define bmbit(r,c) (1 << ((r)*rm->ncols+(c) & 7)) |
763 |
– |
#define bmop(r,c, op) (bmbyte(r,c) op bmbit(r,c)) |
764 |
– |
#define bmtest(r,c) bmop(r,c,&) |
765 |
– |
#define bmset(r,c) bmop(r,c,|=) |
766 |
– |
#define bmtestandset(r,c) (!bmtest(r,c) && bmset(r,c)) |
761 |
|
uby8 *bmap; |
762 |
|
rmx_dtype val[MAXCOMP]; |
763 |
|
RMATRIX dold; |
786 |
|
} |
787 |
|
return(1); |
788 |
|
} |
789 |
< |
/* clear completion bitmap */ |
789 |
> |
#define bmbyte(r,c) bmap[((r)*rm->ncols+(c))>>3] |
790 |
> |
#define bmbit(r,c) (1 << ((r)*rm->ncols+(c) & 7)) |
791 |
> |
#define bmop(r,c, op) (bmbyte(r,c) op bmbit(r,c)) |
792 |
> |
#define bmtest(r,c) bmop(r,c,&) |
793 |
> |
#define bmset(r,c) bmop(r,c,|=) |
794 |
> |
/* loop completion bitmap */ |
795 |
|
bmap = (uby8 *)calloc(((size_t)rm->nrows*rm->ncols+7)>>3, 1); |
796 |
|
if (!bmap) |
797 |
|
return(0); |
798 |
|
dold = *rm; |
799 |
|
rm->ncols = dold.nrows; rm->nrows = dold.ncols; |
800 |
< |
for (i = rm->nrows; i--; ) |
800 |
> |
for (i = rm->nrows; i--; ) /* try every starting point */ |
801 |
|
for (j = rm->ncols; j--; ) { |
802 |
|
int i0, j0; |
803 |
|
int i1 = i; |
804 |
|
size_t j1 = j; |
805 |
< |
if (!bmtestandset(i,j)) continue; |
805 |
> |
if (bmtest(i, j)) |
806 |
> |
continue; /* traversed loop earlier */ |
807 |
|
memcpy(val, rmx_val(rm,i,j), |
808 |
|
sizeof(rmx_dtype)*rm->ncomp); |
809 |
< |
for ( ; ; ) { /* value transpose loop */ |
810 |
< |
const rmx_dtype *src; |
811 |
< |
i0 = i1; j0 = (int)j1; |
812 |
< |
src = rmx_val(&dold, j0, i0); |
813 |
< |
j1 = (src - dold.mtx)/dold.ncomp; |
809 |
> |
for ( ; ; ) { /* new transpose loop */ |
810 |
> |
const rmx_dtype *ds; |
811 |
> |
i0 = i1; j0 = j1; |
812 |
> |
ds = rmx_val(&dold, j0, i0); |
813 |
> |
j1 = (ds - dold.mtx)/dold.ncomp; |
814 |
|
i1 = j1 / rm->ncols; |
815 |
< |
j1 -= i1*rm->ncols; |
816 |
< |
if (!bmtestandset(i1,j1)) break; |
817 |
< |
memcpy(rmx_lval(rm,i0,j0), src, |
815 |
> |
j1 -= (size_t)i1*rm->ncols; |
816 |
> |
bmset(i1, j1); /* mark as done */ |
817 |
> |
if ((i1 == i) & (j1 == j)) |
818 |
> |
break; /* back at start */ |
819 |
> |
memcpy(rmx_lval(rm,i0,j0), ds, |
820 |
|
sizeof(rmx_dtype)*rm->ncomp); |
821 |
< |
} |
820 |
< |
/* close the loop */ |
821 |
> |
} /* complete the loop */ |
822 |
|
memcpy(rmx_lval(rm,i0,j0), val, |
823 |
|
sizeof(rmx_dtype)*rm->ncomp); |
824 |
|
} |
829 |
|
#undef bmop |
830 |
|
#undef bmtest |
831 |
|
#undef bmset |
831 |
– |
#undef bmtestandset |
832 |
|
} |
833 |
|
|
834 |
|
/* Multiply (concatenate) two matrices and allocate the result */ |