wolffd@0: /* C mex version of ind2subv.m in misc directory */
wolffd@0: /* 2 input, 1 output         */
wolffd@0: /* siz, ndx                  */
wolffd@0: /* sub                       */
wolffd@0: 
wolffd@0: #include "mex.h"
wolffd@0: #include <math.h>
wolffd@0: 
wolffd@0: void rbinary(int num, int n, double *rbits){
wolffd@0: 	int i, mask;
wolffd@0: 	num = num - 1;
wolffd@0: 
wolffd@0: 	mask = 1 << (n-1); /* mask = 00100...0 , where the 1 is in column n (rightmost = col 1) */
wolffd@0: 	for (i = 0; i < n; i++) {
wolffd@0: 		rbits[n-i-1] = ((num & mask) == 0) ? 1 : 2;
wolffd@0: 		num <<= 1;
wolffd@0: 	}
wolffd@0: }
wolffd@0: 
wolffd@0: void ind_subv(int num, const double *sizes, int n, double *rbits){
wolffd@0: 	int i;
wolffd@0: 	int *cumprod;
wolffd@0: 
wolffd@0: 	cumprod  = malloc(n * sizeof(int));
wolffd@0: 	num = num - 1;
wolffd@0: 	cumprod[0] = 1;
wolffd@0: 	for (i = 0; i < n-1; i++)
wolffd@0: 	cumprod[i+1] = cumprod[i] * (int)sizes[i];
wolffd@0: 	for (i = n-1; i >= 0; i--) {
wolffd@0: 		rbits[i] = ((int)floor(num / cumprod[i])) + 1;
wolffd@0: 		num = num % cumprod[i];
wolffd@0: 	}
wolffd@0: 	free(cumprod);
wolffd@0: }
wolffd@0: 
wolffd@0: 
wolffd@0: void mexFunction(int nlhs, mxArray *plhs[], int nrhs, const mxArray *prhs[]){
wolffd@0: 	int    i, j, k, nCol, nRow, nnRow, binary, count, temp, temp1, start;
wolffd@0: 	double *pSize, *pNdx, *pr;
wolffd@0: 	double ndx;
wolffd@0: 	int    *subv, *cumprod, *templai;
wolffd@0: 
wolffd@0: 	pSize = mxGetPr(prhs[0]);
wolffd@0: 	pNdx = mxGetPr(prhs[1]);
wolffd@0: 	nCol = mxGetNumberOfElements(prhs[0]);
wolffd@0: 	nnRow = mxGetNumberOfElements(prhs[1]);
wolffd@0: 
wolffd@0: 	nRow = 1;
wolffd@0: 	for(i=0; i<nCol; i++){
wolffd@0: 		nRow *= (int)pSize[i];
wolffd@0: 	}
wolffd@0: 
wolffd@0: 	if(nCol == 0){
wolffd@0: 		plhs[0] = mxDuplicateArray(prhs[1]);
wolffd@0: 		return;
wolffd@0: 	}
wolffd@0: 
wolffd@0: 	binary = 2;
wolffd@0: 	for (i = 0; i < nCol; i++){
wolffd@0: 		if (pSize[i] > 2.0){
wolffd@0: 			binary = 0;
wolffd@0: 			break;
wolffd@0: 		}
wolffd@0: 		else if((int)pSize[i] == 1){
wolffd@0: 			binary = 1;
wolffd@0: 		}
wolffd@0: 	}
wolffd@0: 
wolffd@0: 	if(nnRow == 1){
wolffd@0: 		ndx = mxGetScalar(prhs[1]);
wolffd@0: 		plhs[0] = mxCreateDoubleMatrix(1, nCol, mxREAL);
wolffd@0: 		pr = mxGetPr(plhs[0]);
wolffd@0: 		if(binary == 2)rbinary((int)ndx, nCol, pr);
wolffd@0: 		else ind_subv((int)ndx, pSize, nCol, pr);
wolffd@0: 		return;
wolffd@0: 	}
wolffd@0: 
wolffd@0: 	plhs[0] = mxCreateDoubleMatrix(nnRow, nCol, mxREAL);
wolffd@0: 	pr = mxGetPr(plhs[0]);
wolffd@0: 
wolffd@0: 	subv = malloc(nRow * nCol * sizeof(int));
wolffd@0: 
wolffd@0: 	if (binary == 2) {
wolffd@0: 		for(j=0; j<nCol; j++){
wolffd@0: 			temp = (1 << j);
wolffd@0: 			temp1 = j * nRow;
wolffd@0: 			for(i=0; i<nRow; i++){
wolffd@0: 				subv[temp1 + i] = ((i & temp) == 0) ? 1 : 2;
wolffd@0: 			}
wolffd@0: 		}
wolffd@0: 	}
wolffd@0: 	else if(binary == 1){
wolffd@0: 		cumprod = (int *)malloc(nCol * sizeof(int));
wolffd@0: 		templai = (int *)malloc(nCol * sizeof(int));
wolffd@0: 		cumprod[0] = 1;
wolffd@0: 		templai[0] = nRow;
wolffd@0: 		for(i=1; i<nCol; i++){
wolffd@0: 			k = (int)pSize[i-1] - 1;
wolffd@0: 			cumprod[i] = cumprod[i-1] << k;
wolffd@0: 			templai[i] = templai[i-1] >> k;
wolffd@0: 		}
wolffd@0: 		for(j=0; j<nCol; j++){
wolffd@0: 			temp1 = j * nRow;
wolffd@0: 			if(pSize[j] == 1.0){
wolffd@0: 				for(i=0; i<nRow; i++){
wolffd@0: 					subv[temp1 + i] = 1;
wolffd@0: 				}
wolffd@0: 			}
wolffd@0: 			else{
wolffd@0: 				temp = 1;
wolffd@0: 				count = 0;
wolffd@0: 				for(i=0; i<templai[j]; i++){
wolffd@0: 					if(temp > 2) temp = 1;
wolffd@0: 					for(k=0; k<cumprod[j]; k++){
wolffd@0: 						subv[temp1 + count] = temp;
wolffd@0:                         count++;
wolffd@0: 					}
wolffd@0: 					temp++;
wolffd@0: 				}
wolffd@0: 			}
wolffd@0: 		}
wolffd@0: 		free(templai);
wolffd@0: 		free(cumprod);
wolffd@0: 	}
wolffd@0: 	else {
wolffd@0: 		cumprod = (int *)malloc(nCol * sizeof(int));
wolffd@0: 		templai = (int *)malloc(nCol * sizeof(int));
wolffd@0: 		cumprod[0] = 1;
wolffd@0: 		for(i=1; i<nCol; i++){
wolffd@0: 			cumprod[i] = (int)(cumprod[i-1] * pSize[i-1]);
wolffd@0: 		}
wolffd@0: 		templai[0] = nRow;
wolffd@0: 		for(i=1; i<nCol; i++){
wolffd@0: 			templai[i] = nRow / cumprod[i];
wolffd@0: 		}
wolffd@0: 		for(j=0; j<nCol; j++){
wolffd@0: 			temp1 = j * nRow;
wolffd@0: 			if(pSize[j] == 1.0){
wolffd@0: 				for(i=0; i<nRow; i++){
wolffd@0: 					subv[temp1 + i] = 1;
wolffd@0: 				}
wolffd@0: 			}
wolffd@0: 			else{
wolffd@0: 				temp = 1;
wolffd@0: 				count = 0;
wolffd@0: 				for(i=0; i<templai[j]; i++){
wolffd@0: 					if(temp > (int)pSize[j]) temp = 1;
wolffd@0: 					for(k=0; k<cumprod[j]; k++){
wolffd@0: 						subv[temp1 + count] = temp;
wolffd@0: 						count++;
wolffd@0: 					}
wolffd@0: 					temp++;
wolffd@0: 				}
wolffd@0: 			}
wolffd@0: 		}
wolffd@0: 		free(cumprod);
wolffd@0: 		free(templai);
wolffd@0: 	}
wolffd@0: 
wolffd@0: 	count = 0;
wolffd@0: 	for(j=0; j<nCol; j++){
wolffd@0: 		temp1 = j * nRow;
wolffd@0: 		for(i=0; i<nnRow; i++){
wolffd@0: 			start = (int)pNdx[i] - 1;
wolffd@0: 			pr[count] = subv[temp1 + start];
wolffd@0: 			count++;
wolffd@0: 		}
wolffd@0: 	}
wolffd@0: 	free(subv);
wolffd@0: }
wolffd@0: 
wolffd@0: 
wolffd@0: 
wolffd@0: 
wolffd@0: 
wolffd@0: