Daniel@0: /* marg_table.c  ../potential/tables     */
Daniel@0: 
Daniel@0: 
Daniel@0: /******************************************/
Daniel@0: /* 5 input & 1 output                     */
Daniel@0: /* Big table                              */
Daniel@0: /* Big domain                             */
Daniel@0: /* Big sizes                              */
Daniel@0: /* onto                                   */
Daniel@0: /* maximize, if missed, maximize=0        */
Daniel@0: /*                                        */
Daniel@0: /* small table                            */
Daniel@0: /******************************************/
Daniel@0: 
Daniel@0: #include "mex.h"
Daniel@0: 
Daniel@0: void mexFunction(int nlhs, mxArray *plhs[], int nrhs, const mxArray *prhs[]){
Daniel@0: 	int     i, j, count, NB, NS, siz_b, siz_s, ndim, temp, maximize;
Daniel@0: 	int     *mask, *sx, *sy, *cpsy, *subs, *s, *cpsy2, *ssize;
Daniel@0: 	double  *pb, *ps, *bp, *sp, *pbd;
Daniel@0: 
Daniel@0: 
Daniel@0: 	siz_b = mxGetNumberOfElements(prhs[1]);
Daniel@0: 	siz_s = mxGetNumberOfElements(prhs[3]);
Daniel@0: 	pb = mxGetPr(prhs[1]);
Daniel@0: 	ps = mxGetPr(prhs[3]);
Daniel@0: 
Daniel@0: 	NB = mxGetNumberOfElements(prhs[0]);
Daniel@0: 	bp = mxGetPr(prhs[0]);
Daniel@0: 
Daniel@0: 	pbd = mxGetPr(prhs[2]);
Daniel@0: 
Daniel@0: 	if(nrhs < 5) maximize = 0;
Daniel@0: 	else maximize = (int)mxGetScalar(prhs[4]);
Daniel@0: 
Daniel@0: 	if(siz_s == 0){
Daniel@0: 		plhs[0] = mxCreateDoubleMatrix(1, 1, mxREAL);
Daniel@0: 		sp = mxGetPr(plhs[0]);
Daniel@0: 		if(maximize){
Daniel@0: 			for(i=0; i<NB; i++){
Daniel@0: 				*sp = (*sp < bp[i])? bp[i] : *sp;
Daniel@0: 			}
Daniel@0: 		}
Daniel@0: 		else{
Daniel@0: 			for(i=0; i<NB; i++){
Daniel@0: 				*sp += bp[i];
Daniel@0: 			}
Daniel@0: 		}
Daniel@0: 		return;
Daniel@0: 	}
Daniel@0: 
Daniel@0: 	mask = malloc(siz_s * sizeof(int));
Daniel@0: 	ssize = malloc(siz_s * sizeof(int));
Daniel@0: 	count = 0;
Daniel@0: 	for(i=0; i<siz_s; i++){
Daniel@0: 		for(j=0; j<siz_b; j++){
Daniel@0: 			if(ps[i] == pb[j]){
Daniel@0: 				mask[count] = j;
Daniel@0: 				count++;
Daniel@0: 				break;
Daniel@0: 			}
Daniel@0: 		}
Daniel@0: 	}
Daniel@0: 	
Daniel@0: 	ndim = siz_b;
Daniel@0: 	sx = (int *)malloc(sizeof(int)*ndim);
Daniel@0: 	sy = (int *)malloc(sizeof(int)*ndim);
Daniel@0: 	for(i=0; i<ndim; i++){
Daniel@0: 		sx[i] = (int)pbd[i];
Daniel@0: 		sy[i] = 1;
Daniel@0: 	}
Daniel@0: 	for(i=0; i<siz_s; i++){
Daniel@0: 		temp = mask[i];
Daniel@0: 		sy[temp] = sx[temp];
Daniel@0: 		ssize[i] = sx[temp];
Daniel@0: 	}
Daniel@0: 
Daniel@0: 	NS = 1;
Daniel@0: 	for(i=0; i<ndim; i++){
Daniel@0: 		NS *= sy[i];
Daniel@0: 	}
Daniel@0: 
Daniel@0: 	plhs[0] = mxCreateNumericArray(siz_s, ssize, mxDOUBLE_CLASS, mxREAL);
Daniel@0: 	sp = mxGetPr(plhs[0]);
Daniel@0: 
Daniel@0: 	if(NS == 1){
Daniel@0: 		if(maximize){
Daniel@0: 			for(i=0; i<NB; i++){
Daniel@0: 				*sp = (*sp < bp[i])? bp[i] : *sp;
Daniel@0: 			}
Daniel@0: 		}
Daniel@0: 		else{
Daniel@0: 			for(i=0; i<NB; i++){
Daniel@0: 				*sp += bp[i];
Daniel@0: 			}
Daniel@0: 		}
Daniel@0: 		free(mask);
Daniel@0: 		free(sx);
Daniel@0: 		free(sy);
Daniel@0: 		free(ssize);
Daniel@0: 		return;
Daniel@0: 	}
Daniel@0: 
Daniel@0: 	if(NS == NB){
Daniel@0: 		for(i=0; i<NB; i++) *sp++ = *bp++;
Daniel@0: 		free(mask);
Daniel@0: 		free(sx);
Daniel@0: 		free(sy);
Daniel@0: 		free(ssize);
Daniel@0: 		return;
Daniel@0: 	}
Daniel@0: 
Daniel@0: 	s = (int *)malloc(sizeof(int)*ndim);
Daniel@0: 	*(cpsy = (int *)malloc(sizeof(int)*ndim)) = 1;
Daniel@0: 	subs =   (int *)malloc(sizeof(int)*ndim);
Daniel@0: 	cpsy2 =  (int *)malloc(sizeof(int)*ndim);
Daniel@0: 	for(i = 0; i < ndim; i++){
Daniel@0: 		subs[i] = 0;
Daniel@0: 		s[i] = sx[i] - 1;
Daniel@0: 	}
Daniel@0: 			
Daniel@0: 	for(i = 0; i < ndim-1; i++){
Daniel@0: 		cpsy[i+1] = cpsy[i]*sy[i]--;
Daniel@0: 		cpsy2[i] = cpsy[i]*sy[i];
Daniel@0: 	}
Daniel@0: 	cpsy2[ndim-1] = cpsy[ndim-1]*(--sy[ndim-1]);
Daniel@0: 
Daniel@0: 	if(maximize){
Daniel@0: 		for(j=0; j<NB; j++){
Daniel@0: 			*sp = (*sp < *bp)? *bp : *sp;
Daniel@0: 			bp++;
Daniel@0: 			for(i = 0; i < ndim; i++){
Daniel@0: 				if(subs[i] == s[i]){
Daniel@0: 					subs[i] = 0;
Daniel@0: 					if(sy[i])
Daniel@0: 						sp -= cpsy2[i];
Daniel@0: 				}
Daniel@0: 				else{
Daniel@0: 					subs[i]++;
Daniel@0: 					if(sy[i])
Daniel@0: 						sp += cpsy[i];
Daniel@0: 					break;
Daniel@0: 				}
Daniel@0: 			}
Daniel@0: 		}
Daniel@0: 	}
Daniel@0: 	else{
Daniel@0: 		for(j=0; j<NB; j++){
Daniel@0: 			*sp += *bp++;
Daniel@0: 			for(i = 0; i < ndim; i++){
Daniel@0: 				if(subs[i] == s[i]){
Daniel@0: 					subs[i] = 0;
Daniel@0: 					if(sy[i])
Daniel@0: 						sp -= cpsy2[i];
Daniel@0: 				}
Daniel@0: 				else{
Daniel@0: 					subs[i]++;
Daniel@0: 					if(sy[i])
Daniel@0: 						sp += cpsy[i];
Daniel@0: 					break;
Daniel@0: 				}
Daniel@0: 			}
Daniel@0: 		}
Daniel@0: 	}
Daniel@0: 
Daniel@0: 	free(sx);
Daniel@0: 	free(sy);
Daniel@0: 	free(s);
Daniel@0: 	free(cpsy);
Daniel@0: 	free(subs);
Daniel@0: 	free(cpsy2);
Daniel@0:     free(mask);
Daniel@0: 	free(ssize);
Daniel@0: }
Daniel@0: