282 lines
12 KiB
C
282 lines
12 KiB
C
/*
|
|
* Copyright (C) 2022 NHR@FAU, University Erlangen-Nuremberg.
|
|
* All rights reserved. This file is part of nusif-solver.
|
|
* Use of this source code is governed by a MIT style
|
|
* license that can be found in the LICENSE file.
|
|
*/
|
|
#include <float.h>
|
|
#include <math.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
|
|
#include "vtkWriter.h"
|
|
|
|
#define U(i, j, k) u[(k) * (imax + 2) * (jmax + 2) + (j) * (imax + 2) + (i)]
|
|
#define V(i, j, k) v[(k) * (imax + 2) * (jmax + 2) + (j) * (imax + 2) + (i)]
|
|
#define W(i, j, k) w[(k) * (imax + 2) * (jmax + 2) + (j) * (imax + 2) + (i)]
|
|
|
|
static int ts = 0;
|
|
void printParticles(ParticleTracer* particletracer)
|
|
{
|
|
for(int i = 0; i < particletracer->totalParticles; ++i)
|
|
{
|
|
printf("Particle position X : %.2f, Y : %.2f, flag : %d\n", particletracer->particlePool[i].x,
|
|
particletracer->particlePool[i].y,
|
|
particletracer->particlePool[i].flag);
|
|
}
|
|
}
|
|
void injectParticles(ParticleTracer* particletracer)
|
|
{
|
|
for(int i = 0; i < particletracer->numberOfParticles; ++i)
|
|
{
|
|
|
|
particletracer->particlePool[particletracer->pointer].x = particletracer->linSpaceLine[i].x;
|
|
particletracer->particlePool[particletracer->pointer].y = particletracer->linSpaceLine[i].y;
|
|
particletracer->particlePool[particletracer->pointer].z = particletracer->linSpaceLine[i].z;
|
|
|
|
particletracer->particlePool[particletracer->pointer].flag = true;
|
|
++(particletracer->pointer);
|
|
++(particletracer->totalParticles);
|
|
}
|
|
}
|
|
|
|
void advanceParticles(ParticleTracer* particletracer, double* restrict u, double* restrict v, double* restrict w, double time)
|
|
{
|
|
int imax = particletracer->imax;
|
|
int jmax = particletracer->jmax;
|
|
int kmax = particletracer->kmax;
|
|
|
|
|
|
|
|
double dx = particletracer->dx;
|
|
double dy = particletracer->dy;
|
|
double dz = particletracer->dz;
|
|
|
|
|
|
double xlength = particletracer->xlength;
|
|
double ylength = particletracer->ylength;
|
|
double zlength = particletracer->zlength;
|
|
|
|
|
|
for(int i = 0; i < particletracer->totalParticles; ++i)
|
|
{
|
|
if(particletracer->particlePool[i].flag == true)
|
|
{
|
|
double x = particletracer->particlePool[i].x;
|
|
double y = particletracer->particlePool[i].y;
|
|
double z = particletracer->particlePool[i].z;
|
|
|
|
int iCoord = (int)(x / dx) + 1;
|
|
int jCoord = (int)((y + 0.5 * dy) / dy) + 1;
|
|
int kCoord = (int)((z + 0.5 * dz) / dz) + 1;
|
|
|
|
|
|
double x1 = (double)(iCoord - 1) * dx;
|
|
double y1 = ((double)(jCoord - 1) - 0.5) * dy;
|
|
double z1 = ((double)(kCoord - 1) - 0.5) * dz;
|
|
|
|
double x2 = (double)iCoord * dx;
|
|
double y2 = ((double)jCoord - 0.5) * dy;
|
|
double z2 = ((double)kCoord - 0.5) * dz;
|
|
|
|
|
|
double u_n = (1.0 / (dx * dy * dz)) *
|
|
(
|
|
(x2 - x) * (y2 - y) * (z2 - z) * U(iCoord - 1, jCoord - 1, kCoord - 1) +
|
|
(x - x1) * (y2 - y) * (z2 - z) * U(iCoord, jCoord - 1, kCoord - 1) +
|
|
(x2 - x) * (y - y1) * (z2 - z) * U(iCoord - 1, jCoord, kCoord - 1) +
|
|
(x - x1) * (y - y1) * (z2 - z) * U(iCoord, jCoord, kCoord - 1) +
|
|
(x2 - x) * (y2 - y) * (z - z1) * U(iCoord - 1, jCoord - 1, kCoord) +
|
|
(x - x1) * (y2 - y) * (z - z1) * U(iCoord, jCoord - 1, kCoord) +
|
|
(x2 - x) * (y - y1) * (z - z1) * U(iCoord - 1, jCoord, kCoord) +
|
|
(x - x1) * (y - y1) * (z - z1) * U(iCoord, jCoord, kCoord)
|
|
);
|
|
|
|
double new_x = x + particletracer->dt * u_n;
|
|
particletracer->particlePool[i].x = new_x;
|
|
|
|
iCoord = (int)((x + 0.5 * dx) / dx) + 1;
|
|
jCoord = (int)(y / dy) + 1;
|
|
kCoord = (int)((z + 0.5 * dz) / dz) + 1;
|
|
|
|
x1 = ((double)(iCoord - 1) - 0.5) * dx;
|
|
y1 = (double)(jCoord - 1) * dy;
|
|
z1 = ((double)(kCoord - 1) - 0.5) * dz;
|
|
|
|
x2 = ((double)iCoord - 0.5) * dx;
|
|
y2 = (double)jCoord * dy;
|
|
z2 = ((double)kCoord - 0.5) * dz;
|
|
|
|
double v_n = (1.0 / (dx * dy * dz)) *
|
|
(
|
|
(x2 - x) * (y2 - y) * (z2 - z) * V(iCoord - 1, jCoord - 1, kCoord - 1) +
|
|
(x - x1) * (y2 - y) * (z2 - z) * V(iCoord, jCoord - 1, kCoord - 1) +
|
|
(x2 - x) * (y - y1) * (z2 - z) * V(iCoord - 1, jCoord, kCoord - 1) +
|
|
(x - x1) * (y - y1) * (z2 - z) * V(iCoord, jCoord, kCoord - 1) +
|
|
(x2 - x) * (y2 - y) * (z - z1) * V(iCoord - 1, jCoord - 1, kCoord) +
|
|
(x - x1) * (y2 - y) * (z - z1) * V(iCoord, jCoord - 1, kCoord) +
|
|
(x2 - x) * (y - y1) * (z - z1) * V(iCoord - 1, jCoord, kCoord) +
|
|
(x - x1) * (y - y1) * (z - z1) * V(iCoord, jCoord, kCoord)
|
|
);
|
|
|
|
double new_y = y + particletracer->dt * v_n;
|
|
particletracer->particlePool[i].y = new_y;
|
|
|
|
iCoord = (int)((x + 0.5 * dx) / dx) + 1;
|
|
jCoord = (int)((y + 0.5 * dy) / dy) + 1;
|
|
kCoord = (int)(z / dz) + 1;
|
|
|
|
x1 = ((double)(iCoord - 1) - 0.5) * dx;
|
|
y1 = ((double)(jCoord - 1) - 0.5) * dy;
|
|
z1 = (double)(kCoord - 1) * dz;
|
|
|
|
x2 = ((double)iCoord - 0.5) * dx;
|
|
y2 = ((double)jCoord - 0.5) * dy;
|
|
z2 = (double)kCoord * dz;
|
|
|
|
double w_n = (1.0 / (dx * dy * dz)) *
|
|
(
|
|
(x2 - x) * (y2 - y) * (z2 - z) * W(iCoord - 1, jCoord - 1, kCoord - 1) +
|
|
(x - x1) * (y2 - y) * (z2 - z) * W(iCoord, jCoord - 1, kCoord - 1) +
|
|
(x2 - x) * (y - y1) * (z2 - z) * W(iCoord - 1, jCoord, kCoord - 1) +
|
|
(x - x1) * (y - y1) * (z2 - z) * W(iCoord, jCoord, kCoord - 1) +
|
|
(x2 - x) * (y2 - y) * (z - z1) * W(iCoord - 1, jCoord - 1, kCoord) +
|
|
(x - x1) * (y2 - y) * (z - z1) * W(iCoord, jCoord - 1, kCoord) +
|
|
(x2 - x) * (y - y1) * (z - z1) * W(iCoord - 1, jCoord, kCoord) +
|
|
(x - x1) * (y - y1) * (z - z1) * W(iCoord, jCoord, kCoord)
|
|
);
|
|
|
|
double new_z = z + particletracer->dt * w_n;
|
|
particletracer->particlePool[i].z = new_z;
|
|
|
|
// printf("\tOld X : %.2f, New X : %.2f, iCoord : %d\n\tOld Y : %.2f, New Y : %.2f, jCoord : %d\n\n", x, new_x, iCoord, y, new_y, jCoord);
|
|
// printf("\tU(iCoord - 1, jCoord - 1) : %.2f, U(iCoord, jCoord - 1) : %.2f, U(iCoord - 1, jCoord) : %.2f, U(iCoord, jCoord) : %.2f\n", U(iCoord - 1, jCoord - 1), U(iCoord, jCoord - 1), U(iCoord - 1, jCoord), U(iCoord, jCoord));
|
|
// printf("\tV(iCoord - 1, jCoord - 1) : %.2f, V(iCoord, jCoord - 1) : %.2f, V(iCoord - 1, jCoord) : %.2f, V(iCoord, jCoord) : %.2f\n\n", V(iCoord - 1, jCoord - 1), V(iCoord, jCoord - 1), V(iCoord - 1, jCoord), V(iCoord, jCoord));
|
|
// printf("\t U N : %.2f, V N : %.2f\n\n", u_n, v_n);
|
|
// printf("\t j-1 * (imax + 2) + i-1 = %d with element from U : %.2f", (jCoord - 1) * (200 + 2) + (iCoord - 1), u[(jCoord - 1) * (imax + 2) + (iCoord - 1)]);
|
|
// printf("\nimax : %d, jmax : %d\n", imax, jmax);
|
|
|
|
if (((new_x < 0.0) || (new_x > xlength) || (new_y < 0.0) || (new_y > ylength) || (new_z < 0.0) || (new_z > zlength)))
|
|
{
|
|
particletracer->particlePool[i].flag = false;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void freeParticles(ParticleTracer* particletracer)
|
|
{
|
|
free(particletracer->particlePool);
|
|
free(particletracer->linSpaceLine);
|
|
}
|
|
|
|
void writeParticles(ParticleTracer* particletracer, Solver* solver)
|
|
{
|
|
VtkOptions opts = { .particletracer = particletracer };
|
|
|
|
char filename[50];
|
|
snprintf(filename, 50, "vtk_files/particles%d.vtk", ts);
|
|
vtkOpenPT(&opts, filename, ts);
|
|
vtkParticle(&opts, "particle");
|
|
vtkClose(&opts);
|
|
++ts;
|
|
}
|
|
|
|
void initParticleTracer(ParticleTracer* particletracer, Parameter* params)
|
|
{
|
|
particletracer->numberOfParticles = params->numberOfParticles;
|
|
particletracer->startTime = params->startTime;
|
|
particletracer->injectTimePeriod = params->injectTimePeriod;
|
|
particletracer->writeTimePeriod = params->writeTimePeriod;
|
|
|
|
particletracer->dt = params->dt;
|
|
particletracer->dx = params->xlength / params->imax;
|
|
particletracer->dy = params->ylength / params->jmax;
|
|
particletracer->dz = params->zlength / params->kmax;
|
|
|
|
|
|
particletracer->xlength = params->xlength;
|
|
particletracer->ylength = params->ylength;
|
|
particletracer->zlength = params->zlength;
|
|
|
|
|
|
particletracer->x1 = params->x1;
|
|
particletracer->y1 = params->y1;
|
|
particletracer->z1 = params->z1;
|
|
particletracer->x2 = params->x2;
|
|
particletracer->y2 = params->y2;
|
|
particletracer->z2 = params->z2;
|
|
|
|
particletracer->lastInjectTime = params->startTime;
|
|
particletracer->lastUpdateTime = params->startTime;
|
|
particletracer->lastWriteTime = params->startTime;
|
|
|
|
particletracer->pointer = 0;
|
|
particletracer->totalParticles = 0;
|
|
|
|
particletracer->imax = params->imax;
|
|
particletracer->jmax = params->jmax;
|
|
particletracer->kmax = params->kmax;
|
|
|
|
particletracer->estimatedNumParticles = ((params->te - params->startTime) + 2 ) * params->numberOfParticles;
|
|
|
|
particletracer->particlePool = malloc(sizeof(Particle) * particletracer->estimatedNumParticles);
|
|
particletracer->linSpaceLine = malloc(sizeof(Particle) * particletracer->numberOfParticles);
|
|
|
|
for (int i = 0; i < particletracer->numberOfParticles; ++i)
|
|
{
|
|
double spacing = (double)i / (double)(particletracer->numberOfParticles - 1);
|
|
particletracer->linSpaceLine[i].x = spacing * particletracer->x1 + (1.0 - spacing) * particletracer->x2;
|
|
particletracer->linSpaceLine[i].y = spacing * particletracer->y1 + (1.0 - spacing) * particletracer->y2;
|
|
particletracer->linSpaceLine[i].z = spacing * particletracer->z1 + (1.0 - spacing) * particletracer->z2;
|
|
|
|
particletracer->linSpaceLine[i].flag = true;
|
|
}
|
|
|
|
}
|
|
|
|
void printParticleTracerParameters(ParticleTracer* particletracer)
|
|
{
|
|
printf("Particle Tracing data:\n");
|
|
printf("\tNumber of particles : %d being injected for every period of %.2f\n", particletracer->numberOfParticles, particletracer->injectTimePeriod);
|
|
printf("\tstartTime : %.2f\n", particletracer->startTime);
|
|
printf("\t(Line along which the particles are to be injected) \n\tx1 : %.2f, y1 : %.2f, z1 : %.2f, x2 : %.2f, y2 : %.2f, z2 : %.2f\n", particletracer->x1, particletracer->y1, particletracer->z1, particletracer->x2, particletracer->y2, particletracer->z2);
|
|
printf("\tPointer : %d, TotalParticles : %d\n", particletracer->pointer, particletracer->totalParticles);
|
|
printf("\tdt : %.2f, dx : %.2f, dy : %.2f, dz : %.2f\n", particletracer->dt, particletracer->dx, particletracer->dy, particletracer->dz);
|
|
}
|
|
|
|
void trace(ParticleTracer* particletracer, Solver* solver, double* u, double* v, double* w, double time)
|
|
{
|
|
if (time >= particletracer->startTime)
|
|
{
|
|
//printParticles(particletracer);
|
|
if( (time - particletracer->lastInjectTime) >= particletracer->injectTimePeriod)
|
|
{
|
|
injectParticles(particletracer);
|
|
particletracer->lastInjectTime = time;
|
|
}
|
|
if( (time - particletracer->lastWriteTime) >= particletracer->writeTimePeriod)
|
|
{
|
|
activeParticleChecker(particletracer);
|
|
writeParticles(particletracer, solver);
|
|
particletracer->lastWriteTime = time;
|
|
|
|
}
|
|
advanceParticles(particletracer, u, v, w, time);
|
|
particletracer->lastUpdateTime = time;
|
|
}
|
|
}
|
|
|
|
void activeParticleChecker(ParticleTracer* particletracer)
|
|
{
|
|
particletracer->activeParticles = 0;
|
|
Particle* particlePool = particletracer->particlePool;
|
|
for (int i = 0; i < particletracer->totalParticles; ++i)
|
|
{
|
|
if(particlePool[i].flag == true)
|
|
{
|
|
++(particletracer->activeParticles);
|
|
}
|
|
}
|
|
} |