| 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 */ |