Newer
Older
#endif
#include <stdlib.h>
#include <stdio.h>
#include "mpi.h"
//#include "pardef.h"
#include "util.h"
// NOTA: vedere come e cosa cambia aumentando i valori nAstroPSolved, nAttP e nInstrConst facendoli non usuali ma molto grossi
void aprod(int mode, long int m, long int n, double *vVect, double *knownTerms,
double *systemMatrix, long int *matrixIndex, int *instrCol, int *instrConstrIlung, struct comData comlsqr, time_t *ompSec)
// Parallel definitions
int myid, nproc;
long int *mapNoss, *mapNcoeff;
int nthreads, tid, ntasks;
long **mapForThread;
/// struct comData *comlsqr;
//
double zero = 0.0;
double sum, yi;
long int l1, l2;
long int i, i1;
long int l, j, k;
int i2 = 0, j2 = 0, j3 = 0, na = 0;
int setBound[4];
int nAstroPSolved = comlsqr.nAstroPSolved;
long localAstro = comlsqr.VrIdAstroPDim * nAstroPSolved;
long localAstroMax = comlsqr.VrIdAstroPDimMax * nAstroPSolved;
// Initialize.
myid = comlsqr.myid;
nproc = comlsqr.nproc;
mapNcoeff = comlsqr.mapNcoeff;
mapNoss = comlsqr.mapNoss;
nthreads = comlsqr.nthreads;
ntasks= comlsqr.ntasks;
mapForThread = comlsqr.mapForThread;
int multMI = comlsqr.multMI;
long nparam = comlsqr.parOss;
short nAttAxes = comlsqr.nAttAxes;
int numOfExtStar = comlsqr.numOfExtStar;
int numOfBarStar = comlsqr.numOfBarStar;
int numOfExtAttCol = comlsqr.numOfExtAttCol;
long VrIdAstroPDimMax = comlsqr.VrIdAstroPDimMax;
int startingAttColExtConstr = comlsqr.startingAttColExtConstr;
int nOfElextObs = comlsqr.nOfElextObs;
int nEqExtConstr = comlsqr.nEqExtConstr;
int nOfElBarObs = comlsqr.nOfElBarObs;
int nEqBarConstr = comlsqr.nEqBarConstr;
int debugMode = comlsqr.debugMode;
int nInstrPSolved = comlsqr.nInstrPSolved;
int nOfInstrConstr = comlsqr.nOfInstrConstr;
int nElemIC = comlsqr.nElemIC;
int nAttP = comlsqr.nAttP;
int nGlobP = comlsqr.nGlobP;
setBound[0] = comlsqr.setBound[0];
setBound[1] = comlsqr.setBound[1];
setBound[2] = comlsqr.setBound[2];
setBound[3] = comlsqr.setBound[3];
long nDegFreedomAtt = comlsqr.nDegFreedomAtt;
long offsetAttParam = comlsqr.offsetAttParam;
long offsetInstrParam = comlsqr.offsetInstrParam;
long offsetGlobParam = comlsqr.offsetGlobParam;
printf("ERROR: Invalid mode=%d in aprod function\n", mode);
exit(1);
l1 = 0;
l2 = 0;
myid = comlsqr.myid;
if (mode == 1)
if (comlsqr.itn == 1 && debugMode)
printf("PE=%d Aprod1 OpenMP num of threads =%d from thread =%d icycle=%ld comlsqr.itn=%d\n", myid, nthreads, tid, i, comlsqr.itn);
long miValAstro = 0;
long miValAtt = 0;
long jstartAtt = 0;
long jstartAstro = 0;
long lset = 0;
long offLocalAstro = 0;
long offLocalAtt = 0;
long offLocalInstr = 0; //Offset on Instruments
long ixInstr = 0;
int nInstrVal = 0;
offLocalInstr = offsetInstrParam + (localAstroMax - offsetAttParam); //Offset on Instruments
nInstrVal = nAstroPSolved + nAttP;
offLocalAstro = comlsqr.mapStar[myid][0] * nAstroPSolved; //Offset on my mstars
offLocalAtt = localAstroMax - offsetAttParam; //Offset on attitude
long offLocalGlob = offsetGlobParam + (localAstroMax - offsetAttParam); //Offset on GlobP
int nGlobVal = nAstroPSolved + nAttP + nInstrPSolved;
for(int nt=0; nt < ntasks; nt++ )
{
#pragma omp task label(mode1)
{
for (long ix = mapForThread[nt][0]; ix < mapForThread[nt][2]; ix++) //FUNZIONE DA FARE
{
knownTerms[ix] += aprodM1Obs(ix,comlsqr, vVect, systemMatrix, matrixIndex, instrCol);
/// Mode 1 ExtConstr
if (nEqExtConstr)
{
long offExtAtt;
long offExtAttConstr = VrIdAstroPDimMax * nAstroPSolved + startingAttColExtConstr;
long vVIx;
long ktIx = mapNoss[myid];
long offExtConstr;
for (int iexc = 0; iexc < nEqExtConstr; iexc++)
{
sum = 0.0;
offExtConstr = mapNcoeff[myid] + iexc * nOfElextObs;
for (int j3 = 0; j3 < numOfExtStar * nAstroPSolved; j3++)
sum += systemMatrix[offExtConstr + j3] * vVect[j3];
for (int nax = 0; nax < nAttAxes; nax++)
{
offExtAtt = offExtConstr + numOfExtStar * nAstroPSolved + nax * numOfExtAttCol;
vVIx = offExtAttConstr + nax * nDegFreedomAtt;
for (int j3 = 0; j3 < numOfExtAttCol; j3++)
sum += systemMatrix[offExtAtt + j3] * vVect[vVIx + j3];
}
knownTerms[ktIx + iexc] += sum;
} //for iexc
}
//////////////////////////////////////////////////////
/// Mode 1 BarConstr
if (nEqBarConstr)
{
long offBarConstr = mapNcoeff[myid] + nOfElextObs * nEqExtConstr;
long offBarConstrIx;
long ktIx = mapNoss[myid] + nEqExtConstr;
for (int iexc = 0; iexc < nEqBarConstr; iexc++)
{
sum = 0.0;
offBarConstrIx = offBarConstr + iexc * nOfElBarObs;
for (int j3 = 0; j3 < numOfBarStar * nAstroPSolved; j3++)
sum += systemMatrix[offBarConstrIx + j3] * vVect[j3];
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
knownTerms[ktIx + iexc] += sum;
} //for iexc
}
//////////////////////////////////////////////////////
/// Mode 1 InstrConstr
if (nOfInstrConstr)
{
long offSetInstr = 0;
long offSetInstrInc = 0;
long offSetInstrInc1 = 0;
long vVix = 0;
long offvV = 0;
long offSetInstrConstr = mapNcoeff[myid] + nOfElextObs * nEqExtConstr + nOfElBarObs * nEqBarConstr;
long offSetInstrConstr1 = VrIdAstroPDimMax * nAstroPSolved + nDegFreedomAtt * nAttAxes;
long ktIx = mapNoss[myid] + nEqExtConstr + nEqBarConstr;
for (int i1 = myid; i1 < nOfInstrConstr; i1 = i1 + nproc)
{
sum = 0.0;
offSetInstrInc = offSetInstrConstr;
offSetInstr = 0;
for (int m = 0; m < i1; m++)
{
offSetInstrInc += instrConstrIlung[m];
offSetInstr += instrConstrIlung[m];
}
offvV = mapNoss[myid] * nInstrPSolved + offSetInstr;
for (int j3 = 0; j3 < instrConstrIlung[i1]; j3++)
{
vVix = instrCol[offvV + j3];
sum += systemMatrix[offSetInstrInc + j3] * vVect[offSetInstrConstr1 + vVix];
}
knownTerms[ktIx + i1] += sum;
}
}
//////////////////////////////////////////////////////
*ompSec += time(NULL) - startTime;
if (comlsqr.itn <= 2 && (myid == 0 || myid == nproc - 1 || debugMode == 1))
printf("PE=%d AprodTiming: mode=1 OmpSec=%ld\n", myid, time(NULL) - startTime);
#pragma omp taskwait
else //mode==2
{ //if(mode
time_t startTime = time(NULL);
int count = 0;
myid = comlsqr.myid;
printf("vVect[1]: %f:\n", vVect[1] );
/////////////////////////////////////////////////////
/// Mode 2 Astrometric Sect
if (nAstroPSolved)
{
long offLocalAstro = comlsqr.mapStar[myid][0] * nAstroPSolved;
long lset;
long jstartAstro;
for(int nt=0; nt < ntasks; nt++ )
{
#pragma omp task label(vVect_nAstroPSolved) //out(vVect[jstartAstro : jstartAstro + nAstroPSolved-1])
{
lset = mapForThread[nt][0] * nparam;
double taskLocalSum;
jstartAstro = 0;
for (long ix = mapForThread[nt][0]; ix < mapForThread[nt][2]; ix++) //QUI e altrove in for(long ix..) richiama una funzione
{
aprodM2AstroP(ix, nt, comlsqr, vVect, systemMatrix, matrixIndex, knownTerms);
} //for ix
}
// #pragma omp taskwait
}
}
/////////////////////////////////////////////////////
/////////////////////////////////////////////////////
/// Mode 2 Attitude Sect
if (nAttP)
{
long mix;
long offj = (localAstroMax - offsetAttParam);
long vVix;
long lset;
for(int nt=0; nt < ntasks; nt++ )
{
#pragma omp task label(nAttP) commutative(vVect)//out(vVect[mix : mix + (nAttAxes-1) * nDegFreedomAtt])
{
for (long ix = mapForThread[nt][0]; ix < mapForThread[nt][2]; ix++)
{
aprodM2AttP(ix, nt, comlsqr, vVect, systemMatrix, matrixIndex, knownTerms);
} //for ix
}
}
/////////////////////////////////////////////////////
/// Mode 2 Instrument Sect
printf("\t\t\t\tnOfInstrConstr: %d", nOfInstrConstr);
if (nOfInstrConstr )
{
int offLset = nAstroPSolved + nAttP;
long iix;
long offj = offsetInstrParam + (localAstroMax - offsetAttParam);
long vVix;
for(int nt=0; nt < ntasks; nt++ )
{
#pragma omp task label(nOfInstrConstr) commutative(vVect) //out(vVect[mix : mix + (nAttAxes-1) * nDegFreedomAtt])
{
long lset;
for (long ix = mapForThread[nt][0]; ix < mapForThread[nt][2]; ix++)
{
aprodM2InstrP(ix, nt, comlsqr, vVect, systemMatrix, instrCol, knownTerms);
} //for ix
}
}
}
/////////////////////////////////////////////////////
*ompSec += time(NULL) - startTime;
if (comlsqr.itn <= 2 && (myid == 0 || myid == nproc - 1 || debugMode == 1))
printf("PE=%d AprodTiming: mode=2.1 OmpSec=%ld\n", myid, time(NULL) - startTime);
/////////////////////////////////////////////////////
/// Mode 2 Global Sect
if (nGlobP )
{
time_t startTime_nGlobP = time(NULL);
long lset;
int offLset = nAstroPSolved + nAttP + nInstrPSolved;
long offj = offsetGlobParam + (localAstroMax - offsetAttParam);
long vVix;
for (long ix = 0; ix < mapNoss[myid]; ix++)
{
aprodM2GlobP(ix, ntasks, comlsqr, vVect, systemMatrix, knownTerms);
if (comlsqr.itn <= 2 && (myid == 0 || myid == nproc - 1 || debugMode == 1))
printf("\tPE=%d AprodTiming: nGlobP sec=%ld\n", myid, time(NULL) - startTime_nGlobP);
}
////////////////////////////////////////////////////
localSum = 0.0;
printf("\t\t\t\nEqExtConstr: %d nEqBarConstr: %d nOfInstrConstr: %d", nEqExtConstr,nEqBarConstr,nOfInstrConstr);
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
#pragma omp taskwait
//////////////////////////////////////////////////////
/// Mode 2 ExtConstr
if (nEqExtConstr && true)
{
time_t startTime_nEqExtConstr = time(NULL);
long offExtStarConstrEq;
long off2;
long off3;
for (int ix = 0; ix < nEqExtConstr; ix++)
{ //stars
yi = knownTerms[mapNoss[myid] + ix];
offExtStarConstrEq = mapNcoeff[myid] + ix * nOfElextObs; //Star offset on the row ix (all the row)
for (long yx = 0; yx < numOfExtStar; yx++)
{
off3 = yx * nAstroPSolved;
off2 = offExtStarConstrEq + off3;
for (int j2 = 0; j2 < nAstroPSolved; j2++)
{
localSum = systemMatrix[off2 + j2] * yi;
vVect[j2 + off3] += localSum;
}
}
} //for ix
long offExtAttConstrEq;
long offExtUnk;
long off1 = VrIdAstroPDimMax * nAstroPSolved + startingAttColExtConstr;
for (int ix = 0; ix < nEqExtConstr; ix++)
{ //att
yi = knownTerms[mapNoss[myid] + ix];
offExtAttConstrEq = mapNcoeff[myid] + ix * nOfElextObs; //Att offset on the row ix (all the row)
offExtAttConstrEq += numOfExtStar * nAstroPSolved; //Att offset inside ix row
for (int nax = 0; nax < nAttAxes; nax++)
{
offExtUnk = off1 + nax * nDegFreedomAtt; // Att offset for Unk array on extConstr
off2 = offExtAttConstrEq + nax * numOfExtAttCol;
for (int jx = 0; jx < numOfExtAttCol; jx++)
{
localSum = systemMatrix[off2 + jx] * yi;
vVect[offExtUnk + jx] += localSum;
}
}
}
if (comlsqr.itn <= 2 && (myid == 0 || myid == nproc - 1 || debugMode == 1))
printf("\tPE=%d AprodTiming: nEqExtConstr sec=%ld\n", myid, time(NULL) - startTime_nEqExtConstr);
}
//////////////////////////////////////////////////////
/// Mode 2 BarConstr
if (nEqBarConstr && true)
{
time_t startTime_nEqBarConstr = time(NULL);
localSum = 0.0;
long off3;
long off2;
for (int ix = 0; ix < nEqBarConstr; ix++)
{ //stars
yi = knownTerms[mapNoss[myid] + nEqExtConstr + ix];
long offBarStarConstrEq = mapNcoeff[myid] + nEqExtConstr * nOfElextObs + ix * nOfElBarObs; //Star offset on the row i2 (all the row)
for (long yx = 0; yx < numOfBarStar; yx++)
{
off3 = yx * nAstroPSolved;
off2 = offBarStarConstrEq + off3;
for (int j2 = 0; j2 < nAstroPSolved; j2++)
{
localSum = systemMatrix[off2 + j2] * yi;
vVect[j2 + off3] += localSum;
}
}
} //for i2
if (comlsqr.itn <= 2 && (myid == 0 || myid == nproc - 1 || debugMode == 1))
printf("\tPE=%d AprodTiming: nEqBarConstr sec=%ld\n", myid, time(NULL) - startTime_nEqBarConstr);
}
//////////////////////////////////////////////////////
/// Mode 2 InstrConstr
if (nOfInstrConstr && true)
{
time_t startTime_nOfInstrConstr = time(NULL);
localSum = 0.0;
int offSetInstr;
long off1;
long offInstrUnk = VrIdAstroPDimMax * nAstroPSolved + nAttAxes * nDegFreedomAtt;
long off2 = mapNoss[myid] + nEqExtConstr + nEqBarConstr;
long off3 = mapNcoeff[myid] + nOfElextObs * nEqExtConstr + nOfElBarObs * nEqBarConstr;
long off4 = mapNoss[myid] * nInstrPSolved;
long off5;
long off6;
for (int k1 = myid; k1 < nOfInstrConstr; k1 = k1 + nproc)
{
yi = knownTerms[off2 + k1];
offSetInstr = 0;
for (int m = 0; m < k1; m++)
offSetInstr += instrConstrIlung[m];
off1 = off3 + offSetInstr;
off5 = off4 + offSetInstr;
for (int j = 0; j < instrConstrIlung[k1]; j++)
{
localSum = systemMatrix[off1 + j] * yi;
off6 = offInstrUnk + instrCol[off5 + j];
vVect[off6] += localSum;
}
}
if (comlsqr.itn <= 2 && (myid == 0 || myid == nproc - 1 || debugMode == 1))
printf("\tPE=%d AprodTiming: nOfInstrConstr sec=%ld\n", myid, time(NULL) - startTime_nOfInstrConstr);
}
////////////
*ompSec += time(NULL) - startTime;
if (comlsqr.itn <= 2 && (myid == 0 || myid == nproc - 1 || debugMode == 1))
printf("PE=%d AprodTiming: mode=2.2 OmpSec=%ld\n", myid, time(NULL) - startTime);