void updateAuxValves(DECLARE_ENGINE_PARAMETER_SIGNATURE) {
if (engineConfiguration->auxValves[0] == GPIO_UNASSIGNED) {
return;
}
float x = getTPS(PASS_ENGINE_PARAMETER_SIGNATURE);
if (cisnan(x)) {
// error should be already reported by now
return;
}
engine->engineState.auxValveStart = interpolate2d("aux", x,
engineConfiguration->fsioCurve1Bins,
engineConfiguration->fsioCurve1, FSIO_CURVE_16);
engine->engineState.auxValveEnd = interpolate2d("aux", x,
engineConfiguration->fsioCurve2Bins,
engineConfiguration->fsioCurve2, FSIO_CURVE_16);
if (engine->engineState.auxValveStart >= engine->engineState.auxValveEnd) {
// this is a fatal error to make this really visible
firmwareError(CUSTOM_AUX_OUT_OF_ORDER, "out of order at %.2f %.2f %.2f", x,
engine->engineState.auxValveStart,
engine->engineState.auxValveEnd);
}
}
void testInterpolate2d(void) {
printf("*************************************************** testInterpolate2d\r\n");
float bins4[] = { 1, 2, 3, 4 };
float values4[] = { 1, 20, 30, 400 };
int size = 4;
int result;
printf("Left size\r\n");
result = interpolate2d(0, bins4, values4, size);
assertEquals(1, result);
printf("Right size\r\n");
result = interpolate2d(10, bins4, values4, size);
assertEquals(400, result);
printf("Middle1\r\n");
result = interpolate2d(3, bins4, values4, size);
assertEquals(30, result);
printf("Middle1\r\n");
result = interpolate2d(3.5, bins4, values4, size);
assertEquals(215, result);
}
/**
* The idea of this method is to execute all heavy calculations in a lower-priority thread,
* so that trigger event handler/IO scheduler tasks are faster.
*/
void Engine::periodicFastCallback(DECLARE_ENGINE_PARAMETER_F) {
int rpm = rpmCalculator.rpmValue;
if (isValidRpm(rpm)) {
MAP_sensor_config_s * c = &engineConfiguration->map;
angle_t start = interpolate2d(rpm, c->samplingAngleBins, c->samplingAngle, MAP_ANGLE_SIZE);
angle_t offsetAngle = TRIGGER_SHAPE(eventAngles[CONFIG(mapAveragingSchedulingAtIndex)]);
for (int i = 0; i < engineConfiguration->specs.cylindersCount; i++) {
angle_t cylinderOffset = getEngineCycle(engineConfiguration->operationMode) * i / engineConfiguration->specs.cylindersCount;
float cylinderStart = start + cylinderOffset - offsetAngle + tdcPosition();
fixAngle(cylinderStart, "cylinderStart");
engine->engineState.mapAveragingStart[i] = cylinderStart;
}
engine->engineState.mapAveragingDuration = interpolate2d(rpm, c->samplingWindowBins, c->samplingWindow, MAP_WINDOW_SIZE);
} else {
for (int i = 0; i < engineConfiguration->specs.cylindersCount; i++) {
engine->engineState.mapAveragingStart[i] = NAN;
}
engine->engineState.mapAveragingDuration = NAN;
}
engineState.periodicFastCallback(PASS_ENGINE_PARAMETER_F);
engine->m.beforeFuelCalc = GET_TIMESTAMP();
ENGINE(fuelMs) = getInjectionDuration(rpm PASS_ENGINE_PARAMETER) * engineConfiguration->globalFuelCorrection;
engine->m.fuelCalcTime = GET_TIMESTAMP() - engine->m.beforeFuelCalc;
}
floatms_t getCrankingFuel3(float coolantTemperature,
uint32_t revolutionCounterSinceStart DECLARE_ENGINE_PARAMETER_S) {
// these magic constants are in Celsius
float baseCrankingFuel = engineConfiguration->cranking.baseFuel;
if (cisnan(coolantTemperature))
return baseCrankingFuel;
float durationCoef = interpolate2d(revolutionCounterSinceStart, config->crankingCycleBins,
config->crankingCycleCoef, CRANKING_CURVE_SIZE);
return interpolate2d(coolantTemperature, config->crankingFuelBins,
config->crankingFuelCoef, CRANKING_CURVE_SIZE) * baseCrankingFuel * durationCoef;
}
void EngineState::updateSlowSensors(DECLARE_ENGINE_PARAMETER_F) {
iat = getIntakeAirTemperature(PASS_ENGINE_PARAMETER_F);
clt = getCoolantTemperature(PASS_ENGINE_PARAMETER_F);
warmupTargetAfr = interpolate2d(clt, engineConfiguration->warmupTargetAfrBins,
engineConfiguration->warmupTargetAfr, WARMUP_TARGET_AFR_SIZE);
}
static void z2fk(void* p, double fi, double fj, double z, double* fk)
{
grid* g = (grid*) p;
gnz_simple* nodes = g->gridnodes_z;
/*
* for sigma coordinates convert `z' to sigma
*/
if (g->vtype == GRIDVTYPE_SIGMA) {
int ni = 0, nj = 0;
double depth;
if (g->htype == GRIDHTYPE_LATLON) {
gnxy_simple* nodes = (gnxy_simple*) g->gridnodes_xy;
ni = nodes->nx;
nj = nodes->ny;
#if !defined(NO_GRIDUTILS)
} else if (g->htype == GRIDHTYPE_CURVILINEAR) {
gnxy_curv* nodes = (gnxy_curv*) g->gridnodes_xy;
ni = gridnodes_getnx(nodes->gn);
nj = gridnodes_getny(nodes->gn);
#endif
} else
enkf_quit("programming error");
depth = (double) interpolate2d(fi, fj, ni, nj, g->depth, g->numlevels, grid_isperiodic_x(g));
z /= depth;
}
*fk = z2fk_basic(nodes->nz, nodes->zt, nodes->zc, z);
}
float AccelEnrichmemnt::getEngineLoadEnrichment(DECLARE_ENGINE_PARAMETER_SIGNATURE) {
int index = getMaxDeltaIndex(PASS_ENGINE_PARAMETER_SIGNATURE);
float d = (cb.get(index) - (cb.get(index - 1))) * CONFIG(specs.cylindersCount);
float result = 0;
int distance = 0;
float taper = 0;
if (d > engineConfiguration->engineLoadAccelEnrichmentThreshold) {
int distance = cb.currentIndex - index;
if (distance <= 0) // checking if indexes are out of order due to circular buffer nature
distance += minI(cb.getCount(), cb.getSize());
taper = interpolate2d("accel", distance, engineConfiguration->mapAccelTaperBins, engineConfiguration->mapAccelTaperMult, MAP_ACCEL_TAPER);
result = taper * d * engineConfiguration->engineLoadAccelEnrichmentMultiplier;
} else if (d < -engineConfiguration->engineLoadDecelEnleanmentThreshold) {
result = d * engineConfiguration->engineLoadAccelEnrichmentMultiplier;
}
#if ! EFI_UNIT_TEST || defined(__DOXYGEN__)
if (engineConfiguration->debugMode == DBG_EL_ACCEL) {
tsOutputChannels.debugIntField1 = distance;
tsOutputChannels.debugFloatField1 = result;
tsOutputChannels.debugFloatField2 = taper;
}
#endif
return result;
}
static void manualIdleController(int positionPercent) {
// todo: this is not great that we have to write into configuration here
boardConfiguration->manIdlePosition = positionPercent;
if (isCranking()) {
positionPercent += engineConfiguration->crankingIdleAdjustment;
}
percent_t cltCorrectedPosition = interpolate2d(engine->engineState.clt, config->cltIdleCorrBins, config->cltIdleCorr,
CLT_CURVE_SIZE) / PERCENT_MULT * positionPercent;
// let's put the value into the right range
cltCorrectedPosition = maxF(cltCorrectedPosition, 0.01);
cltCorrectedPosition = minF(cltCorrectedPosition, 99.9);
if (engineConfiguration->debugMode == IDLE) {
tsOutputChannels.debugFloatField1 = actualIdlePosition;
}
if (absF(cltCorrectedPosition - actualIdlePosition) < 1) {
return; // value is pretty close, let's leave the poor valve alone
}
actualIdlePosition = cltCorrectedPosition;
if (boardConfiguration->useStepperIdle) {
iacMotor.setTargetPosition(cltCorrectedPosition / 100 * engineConfiguration->idleStepperTotalSteps);
} else {
setIdleValvePwm(cltCorrectedPosition);
}
}
void EngineState::periodicFastCallback(DECLARE_ENGINE_PARAMETER_F) {
int rpm = ENGINE(rpmCalculator.rpmValue);
sparkDwell = getSparkDwell(rpm PASS_ENGINE_PARAMETER);
dwellAngle = sparkDwell / getOneDegreeTimeMs(rpm);
iatFuelCorrection = getIatCorrection(iat PASS_ENGINE_PARAMETER);
cltFuelCorrection = getCltCorrection(clt PASS_ENGINE_PARAMETER);
engineNoiseHipLevel = interpolate2d(rpm, engineConfiguration->knockNoiseRpmBins,
engineConfiguration->knockNoise, ENGINE_NOISE_CURVE_SIZE);
baroCorrection = getBaroCorrection(PASS_ENGINE_PARAMETER_F);
injectionOffset = getinjectionOffset(rpm PASS_ENGINE_PARAMETER);
float engineLoad = getEngineLoadT(PASS_ENGINE_PARAMETER_F);
timingAdvance = getAdvance(rpm, engineLoad PASS_ENGINE_PARAMETER);
if (engineConfiguration->algorithm == LM_SPEED_DENSITY) {
float coolantC = ENGINE(engineState.clt);
float intakeC = ENGINE(engineState.iat);
float tps = getTPS(PASS_ENGINE_PARAMETER_F);
tChargeK = convertCelsiusToKelvin(getTCharge(rpm, tps, coolantC, intakeC));
float map = getMap();
/**
* *0.01 because of https://sourceforge.net/p/rusefi/tickets/153/
*/
currentVE = baroCorrection * veMap.getValue(map, rpm) * 0.01;
targerAFR = afrMap.getValue(map, rpm);
} else {
baseTableFuel = getBaseTableFuel(engineConfiguration, rpm, engineLoad);
}
}
void EngineState::updateSlowSensors(DECLARE_ENGINE_PARAMETER_SIGNATURE) {
engine->sensors.iat = getIntakeAirTemperature(PASS_ENGINE_PARAMETER_SIGNATURE);
engine->sensors.clt = getCoolantTemperature(PASS_ENGINE_PARAMETER_SIGNATURE);
engine->sensors.oilPressure = getOilPressure(PASS_ENGINE_PARAMETER_SIGNATURE);
warmupTargetAfr = interpolate2d("warm", engine->sensors.clt, engineConfiguration->warmupTargetAfrBins,
engineConfiguration->warmupTargetAfr, WARMUP_TARGET_AFR_SIZE);
}
/**
* @brief Injector lag correction
* @param vBatt Battery voltage.
* @return Time in ms for injection opening time based on current battery voltage
*/
floatms_t getInjectorLag(float vBatt DECLARE_ENGINE_PARAMETER_S) {
if (cisnan(vBatt)) {
warning(OBD_System_Voltage_Malfunction, "vBatt=%f", vBatt);
return engineConfiguration->injector.lag;
}
float vBattCorrection = interpolate2d(vBatt, engineConfiguration->injector.battLagCorrBins,
engineConfiguration->injector.battLagCorr, VBAT_INJECTOR_CURVE_SIZE);
return engineConfiguration->injector.lag + vBattCorrection;
}
int model_z2fk(model* m, int vid, double fi, double fj, double z, double* fk)
{
void* grid = m->grids[m->vars[vid].gridid];
int isperiodic_x = grid_isperiodic_x(grid);
int** numlevels = grid_getnumlevels(grid);
int ni, nj;
int i1, i2, j1, j2, k2;
if (isnan(fi + fj)) {
*fk = NaN;
return STATUS_OUTSIDEGRID;
}
grid_z2fk(grid, fi, fj, z, fk);
if (isnan(*fk))
return STATUS_OUTSIDEGRID;
if (grid_getvtype(grid) == GRIDVTYPE_SIGMA)
return STATUS_OK;
/*
* a depth check for z-grid:
*/
model_getvardims(m, vid, &ni, &nj, NULL);
i1 = floor(fi);
i2 = ceil(fi);
if (i1 == -1)
i1 = (isperiodic_x) ? ni - 1 : i2;
if (i2 == ni)
i2 = (isperiodic_x) ? 0 : i1;
j1 = floor(fj);
j2 = ceil(fj);
if (j1 == -1)
j1 = j2;
if (j2 == nj)
j2 = j1;
k2 = floor(*fk);
if (numlevels[j1][i1] <= k2 && numlevels[j1][i2] <= k2 && numlevels[j2][i1] <= k2 && numlevels[j2][i2] <= k2) {
*fk = NaN;
return STATUS_LAND;
} else if (numlevels[j1][i1] <= k2 || numlevels[j1][i2] <= k2 || numlevels[j2][i1] <= k2 || numlevels[j2][i2] <= k2) {
float** depth = grid_getdepth(grid);
int ni, nj;
double v;
grid_getdims(grid, &ni, &nj, NULL);
v = interpolate2d(fi, fj, ni, nj, depth, numlevels, grid_isperiodic_x(grid));
if (z > v)
return STATUS_LAND;
}
return STATUS_OK;
}
/**
* @return Spark dwell time, in milliseconds.
*/
float getSparkDwellMsT(engine_configuration_s *engineConfiguration, int rpm) {
if (isCrankingR(rpm)) {
// technically this could be implemented via interpolate2d
float angle = engineConfiguration->crankingChargeAngle;
return getOneDegreeTimeMs(rpm) * angle;
}
efiAssert(!cisnan(rpm), "invalid rpm", NAN);
return interpolate2d(rpm, engineConfiguration->sparkDwellBins, engineConfiguration->sparkDwell, DWELL_CURVE_SIZE);
}
/**
* Here we have a bunch of stuff which should invoked after configuration change
* so that we can prepare some helper structures
*/
void Engine::preCalculate() {
sparkTable.preCalc(engineConfiguration->sparkDwellRpmBins,
engineConfiguration->sparkDwellValues);
/**
* Here we prepare a fast, index-based MAF lookup from a slower curve description
*/
for (int i = 0; i < MAF_DECODING_CACHE_SIZE; i++) {
float volts = i / MAF_DECODING_CACHE_MULT;
float maf = interpolate2d("maf", volts, config->mafDecodingBins,
config->mafDecoding, MAF_DECODING_COUNT);
mafDecodingLookup[i] = maf;
}
}
float getIatCorrection(float iat DECLARE_ENGINE_PARAMETER_S) {
if (cisnan(iat))
return 1; // this error should be already reported somewhere else, let's just handle it
return interpolate2d(iat, config->iatFuelCorrBins, config->iatFuelCorr, IAT_CURVE_SIZE);
}
void PeriodicTask(efitime_t nowNt) override {
UNUSED(nowNt);
setPeriod(GET_PERIOD_LIMITED(&engineConfiguration->etb));
// set debug_mode 17
if (engineConfiguration->debugMode == DBG_ELECTRONIC_THROTTLE_PID) {
#if EFI_TUNER_STUDIO
pid.postState(&tsOutputChannels);
tsOutputChannels.debugIntField5 = feedForward;
#endif /* EFI_TUNER_STUDIO */
} else if (engineConfiguration->debugMode == DBG_ELECTRONIC_THROTTLE_EXTRA) {
#if EFI_TUNER_STUDIO
// set debug_mode 29
tsOutputChannels.debugFloatField1 = directPwmValue;
#endif /* EFI_TUNER_STUDIO */
}
if (shouldResetPid) {
pid.reset();
shouldResetPid = false;
}
if (!cisnan(directPwmValue)) {
etb1.dcMotor.Set(directPwmValue);
return;
}
if (boardConfiguration->pauseEtbControl) {
etb1.dcMotor.Set(0);
return;
}
percent_t actualThrottlePosition = getTPS();
if (engine->etbAutoTune) {
autoTune.input = actualThrottlePosition;
bool result = autoTune.Runtime(&logger);
tuneWorkingPid.updateFactors(autoTune.output, 0, 0);
float value = tuneWorkingPid.getOutput(50, actualThrottlePosition);
scheduleMsg(&logger, "AT input=%f output=%f PID=%f", autoTune.input,
autoTune.output,
value);
scheduleMsg(&logger, "AT PID=%f", value);
etb1.dcMotor.Set(PERCENT_TO_DUTY(value));
if (result) {
scheduleMsg(&logger, "GREAT NEWS! %f/%f/%f", autoTune.GetKp(), autoTune.GetKi(), autoTune.GetKd());
}
return;
}
percent_t targetPosition = getPedalPosition(PASS_ENGINE_PARAMETER_SIGNATURE);
feedForward = interpolate2d("etbb", targetPosition, engineConfiguration->etbBiasBins, engineConfiguration->etbBiasValues, ETB_BIAS_CURVE_LENGTH);
pid.iTermMin = engineConfiguration->etb_iTermMin;
pid.iTermMax = engineConfiguration->etb_iTermMax;
currentEtbDuty = feedForward +
pid.getOutput(targetPosition, actualThrottlePosition);
etb1.dcMotor.Set(PERCENT_TO_DUTY(currentEtbDuty));
if (engineConfiguration->isVerboseETB) {
pid.showPidStatus(&logger, "ETB");
}
}
void EngineState::periodicFastCallback(DECLARE_ENGINE_PARAMETER_SIGNATURE) {
efitick_t nowNt = getTimeNowNt();
if (ENGINE(rpmCalculator).isCranking(PASS_ENGINE_PARAMETER_SIGNATURE)) {
crankingTime = nowNt;
timeSinceCranking = 0.0f;
} else {
timeSinceCranking = nowNt - crankingTime;
}
updateAuxValves(PASS_ENGINE_PARAMETER_SIGNATURE);
int rpm = ENGINE(rpmCalculator).getRpm(PASS_ENGINE_PARAMETER_SIGNATURE);
sparkDwell = getSparkDwell(rpm PASS_ENGINE_PARAMETER_SUFFIX);
dwellAngle = sparkDwell / getOneDegreeTimeMs(rpm);
if (hasAfrSensor(PASS_ENGINE_PARAMETER_SIGNATURE)) {
engine->sensors.currentAfr = getAfr(PASS_ENGINE_PARAMETER_SIGNATURE);
}
// todo: move this into slow callback, no reason for IAT corr to be here
iatFuelCorrection = getIatFuelCorrection(engine->sensors.iat PASS_ENGINE_PARAMETER_SUFFIX);
// todo: move this into slow callback, no reason for CLT corr to be here
if (boardConfiguration->useWarmupPidAfr && engine->sensors.clt < engineConfiguration->warmupAfrThreshold) {
if (rpm < 200) {
cltFuelCorrection = 1;
warmupAfrPid.reset();
} else {
cltFuelCorrection = warmupAfrPid.getValue(warmupTargetAfr, engine->sensors.currentAfr, 1);
}
#if ! EFI_UNIT_TEST || defined(__DOXYGEN__)
if (engineConfiguration->debugMode == DBG_WARMUP_ENRICH) {
tsOutputChannels.debugFloatField1 = warmupTargetAfr;
warmupAfrPid.postState(&tsOutputChannels);
}
#endif
} else {
cltFuelCorrection = getCltFuelCorrection(PASS_ENGINE_PARAMETER_SIGNATURE);
}
// update fuel consumption states
fuelConsumption.update(nowNt PASS_ENGINE_PARAMETER_SUFFIX);
// Fuel cut-off isn't just 0 or 1, it can be tapered
fuelCutoffCorrection = getFuelCutOffCorrection(nowNt, rpm PASS_ENGINE_PARAMETER_SUFFIX);
// post-cranking fuel enrichment.
// for compatibility reasons, apply only if the factor is greater than zero (0.01 margin used)
if (engineConfiguration->postCrankingFactor > 0.01f) {
// convert to microsecs and then to seconds
float timeSinceCrankingInSecs = NT2US(timeSinceCranking) / 1000000.0f;
// use interpolation for correction taper
postCrankingFuelCorrection = interpolateClamped(0.0f, engineConfiguration->postCrankingFactor,
engineConfiguration->postCrankingDurationSec, 1.0f, timeSinceCrankingInSecs);
} else {
postCrankingFuelCorrection = 1.0f;
}
cltTimingCorrection = getCltTimingCorrection(PASS_ENGINE_PARAMETER_SIGNATURE);
engineNoiseHipLevel = interpolate2d("knock", rpm, engineConfiguration->knockNoiseRpmBins,
engineConfiguration->knockNoise, ENGINE_NOISE_CURVE_SIZE);
baroCorrection = getBaroCorrection(PASS_ENGINE_PARAMETER_SIGNATURE);
injectionOffset = getinjectionOffset(rpm PASS_ENGINE_PARAMETER_SUFFIX);
float engineLoad = getEngineLoadT(PASS_ENGINE_PARAMETER_SIGNATURE);
timingAdvance = getAdvance(rpm, engineLoad PASS_ENGINE_PARAMETER_SUFFIX);
if (engineConfiguration->fuelAlgorithm == LM_SPEED_DENSITY) {
float coolantC = ENGINE(sensors.clt);
float intakeC = ENGINE(sensors.iat);
float tps = getTPS(PASS_ENGINE_PARAMETER_SIGNATURE);
tChargeK = convertCelsiusToKelvin(getTCharge(rpm, tps, coolantC, intakeC PASS_ENGINE_PARAMETER_SUFFIX));
float map = getMap();
/**
* *0.01 because of https://sourceforge.net/p/rusefi/tickets/153/
*/
float rawVe = veMap.getValue(rpm, map);
// get VE from the separate table for Idle
if (CONFIG(useSeparateVeForIdle)) {
float idleVe = interpolate2d("idleVe", rpm, config->idleVeBins, config->idleVe, IDLE_VE_CURVE_SIZE);
// interpolate between idle table and normal (running) table using TPS threshold
rawVe = interpolateClamped(0.0f, idleVe, boardConfiguration->idlePidDeactivationTpsThreshold, rawVe, tps);
}
currentVE = baroCorrection * rawVe * 0.01;
targetAFR = afrMap.getValue(rpm, map);
} else {
baseTableFuel = getBaseTableFuel(rpm, engineLoad);
}
}
void SingleParticle2dx::Methods::RealSpaceProjectionMethod::calculateProjection(SingleParticle2dx::DataStructures::Orientation& o, SingleParticle2dx::DataStructures::Projection2d& p)
{
p.resetData();
Eigen::Matrix3f rot = SingleParticle2dx::Utilities::UtilityFunctions::determineRotation(o);
size_type n = p.getSizeX();
size_type x1, y1;
value_type dx, dy;
value_type ii, jj;
Vector3d n_vec, new_vec;
Vector3d n_sizehalf;
n_sizehalf << n/2, n/2, n/2;
real_array2d_type real_data_2d;
real_data_2d.resize( boost::extents[n][n] );
SingleParticle2dx::Utilities::DataContainerFunctions::resetData(&real_data_2d);
real_array3d_type real_data_3d;
real_data_3d.resize( boost::extents[n][n][n] );
m_context->getRealSpaceData(real_data_3d);
std::vector<value_type> interpolated_values (4, value_type(0) );
size_type i, j, k;
for(i=0; i<n; i++)
{
for(j=0; j<n; j++)
{
for(k=0; k<n; k++)
{
n_vec << i, j, k;
n_vec -= n_sizehalf;
new_vec = rot*n_vec;
new_vec += n_sizehalf;
ii = new_vec[0];
jj = new_vec[1];
//if ( (ii<0) || (jj<0) || (ii>=(n-1)) || (jj>=(n-1)) )
//{
// continue;
//}
if (ii<0)
{
ii += n;
}
if (jj<0)
{
jj += n;
}
if (ii >= n)
{
ii -= n;
}
if (jj >= n)
{
jj -= n;
}
x1 = floor(ii);
y1 = floor(jj);
dx = 1 - ii + x1;
dy = 1 - jj + y1;
interpolate2d(dx, dy, real_data_3d[i][j][k], interpolated_values);
real_data_2d[x1][y1] += interpolated_values[0];
real_data_2d[x1+1][y1] += interpolated_values[1];
real_data_2d[x1][y1+1] += interpolated_values[2];
real_data_2d[x1+1][y1+1] += interpolated_values[3];
}
}
}
p.setFourierSpaceData(&real_data_2d);
p.normalizeRealSpace();
p.setOrientation(o);
}
void reader_xy_gridded_hfradar(char* fname, int fid, obsmeta* meta, grid* g, observations* obs)
{
int ksurf = grid_getsurflayerid(g);
int isperiodic_i = grid_isperiodic_i(g);
int** numlevels = grid_getnumlevels(g);
float** grid_angle = grid_getangle(g);
int grid_ni = 0, grid_nj = 0;
char* varname = NULL;
char* u_varname = NULL;
char* v_varname = NULL;
char* u_stdvarname = NULL;
char* v_stdvarname = NULL;
char* lonname = NULL;
char* latname = NULL;
char* gdopname = NULL;
char* npointsname_1 = NULL;
char* npointsname_2 = NULL;
char* stdname = NULL;
char* estdname = NULL;
char* timename = NULL;
char* qcflagname = NULL;
char* u_qcflagname = NULL;
char* v_qcflagname = NULL;
char* rotation_flag = NULL;
int ncid;
int ndim_var, ndim_xy;
size_t dimlen_var[3], dimlen_xy[2];
uint32_t qcflagvals = 0;
float varshift = 0.0;
float u_varshift = 0.0;
float v_varshift = 0.0;
double mindepth = 0.0;
char instrument[MAXSTRLEN];
int iscurv = -1;
int need_rotation = -1;
size_t ni = 0, nj = 0, n = 0, n_var = 0;
int varid_lon = -1, varid_lat = -1;
double* lon = NULL;
double* lat = NULL;
int varid_gdop = -1, varid_npoints_1 = -1, varid_npoints_2 = -1;
int varid_var = -1, varid_std = -1, varid_estd = -1, varid_qcflag = -1, varid_time = -1;
int varid_u = -1, varid_v =-1, varid_u_std = -1, varid_v_std = -1, varid_u_qcflag = -1, varid_v_qcflag = -1;
float* var = NULL;
float* u_var = NULL;
float* v_var = NULL;
float* u_std = NULL;
float* v_std = NULL;
float var_fill_value = NAN;
float var_add_offset = NAN, var_scale_factor = NAN;
float u_var_fill_value = NAN;
float u_var_add_offset = NAN, u_var_scale_factor = NAN;
float v_var_fill_value = NAN;
float v_var_add_offset = NAN, v_var_scale_factor = NAN;
float u_std_fill_value = NAN;
float u_std_add_offset = NAN, u_std_scale_factor = NAN;
float v_std_fill_value = NAN;
float v_std_add_offset = NAN, v_std_scale_factor = NAN;
double var_estd = NAN;
float* gdop = NULL;
short* npoints_1 = NULL;
short* npoints_2 = NULL;
float* std = NULL;
float std_add_offset = NAN, std_scale_factor = NAN;
float std_fill_value = NAN;
float* estd = NULL;
float estd_add_offset = NAN, estd_scale_factor = NAN;
float estd_fill_value = NAN;
int32_t* qcflag = NULL;
int32_t* u_qcflag = NULL;
int32_t* v_qcflag = NULL;
int have_time = 1;
int singletime = -1;
float* time = NULL;
float time_add_offset = NAN, time_scale_factor = NAN;
float time_fill_value = NAN;
char tunits[MAXSTRLEN];
double tunits_multiple = NAN, tunits_offset = NAN;
int i, nobs_read;
strcpy(instrument, meta->product);
for (i = 0; i < meta->npars; ++i) {
if (strcasecmp(meta->pars[i].name, "VARNAME") == 0)
varname = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "ROTATION") == 0)
rotation_flag = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "U_VARNAME") == 0)
u_varname = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "V_VARNAME") == 0)
v_varname = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "U_STD") == 0)
u_stdvarname = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "V_STD") == 0)
v_stdvarname = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "TIMENAME") == 0)
timename = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "GDOPNAME") == 0)
gdopname = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "NPOINTSNAME_1") == 0)
npointsname_1 = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "NPOINTSNAME_2") == 0)
npointsname_2 = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "LONNAME") == 0)
lonname = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "LATNAME") == 0)
latname = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "STDNAME") == 0)
stdname = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "ESTDNAME") == 0)
estdname = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "QCFLAGNAME") == 0)
qcflagname = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "U_QCFLAGNAME") == 0)
u_qcflagname = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "V_QCFLAGNAME") == 0)
v_qcflagname = meta->pars[i].value;
else if (strcasecmp(meta->pars[i].name, "QCFLAGVALS") == 0) {
char* pline = meta->pars[i].value;
int linelen = sizeof(pline);
char lineval[linelen];
char* line = strcpy(lineval,pline);
char seps[] = " ,";
char* token;
int val;
qcflagvals = 0;
while ((token = strtok(line, seps)) != NULL) {
if (!str2int(token, &val))
enkf_quit("%s: could not convert QCFLAGVALS entry \"%s\" to integer", meta->prmfname, token);
if (val < 0 || val > 31)
enkf_quit("%s: QCFLAGVALS entry = %d (supposed to be in [0,31] interval", meta->prmfname, val);
qcflagvals |= 1 << val;
line = NULL;
}
if (qcflagvals == 0)
enkf_quit("%s: no valid flag entries found after QCFLAGVALS\n", meta->prmfname);
} else if (strcasecmp(meta->pars[i].name, "VARSHIFT") == 0) {
if (!str2float(meta->pars[i].value, &varshift))
enkf_quit("%s: can not convert VARSHIFT = \"%s\" to float\n", meta->prmfname, meta->pars[i].value);
enkf_printf(" VARSHIFT = %s\n", meta->pars[i].value);
} else if (strcasecmp(meta->pars[i].name, "U_VARSHIFT") == 0) {
if (!str2float(meta->pars[i].value, &u_varshift))
enkf_quit("%s: can not convert U_VARSHIFT = \"%s\" to float\n", meta->prmfname, meta->pars[i].value);
enkf_printf(" U_VARSHIFT = %s\n", meta->pars[i].value);
} else if (strcasecmp(meta->pars[i].name, "V_VARSHIFT") == 0) {
if (!str2float(meta->pars[i].value, &v_varshift))
enkf_quit("%s: can not convert V_VARSHIFT = \"%s\" to float\n", meta->prmfname, meta->pars[i].value);
enkf_printf(" V_VARSHIFT = %s\n", meta->pars[i].value);
} else if (strcasecmp(meta->pars[i].name, "MINDEPTH") == 0) {
if (!str2double(meta->pars[i].value, &mindepth))
enkf_quit("%s: can not convert MINDEPTH = \"%s\" to double\n", meta->prmfname, meta->pars[i].value);
enkf_printf(" MINDEPTH = %f\n", mindepth);
} else if (strcasecmp(meta->pars[i].name, "INSTRUMENT") == 0) {
strncpy(instrument, meta->pars[i].value, MAXSTRLEN);
} else
enkf_quit("unknown PARAMETER \"%s\"\n", meta->pars[i].name);
}
if (varname == NULL)
enkf_quit("reader_xy_gridded(): %s variable name not specified", fname);
if (rotation_flag != NULL) {
int bool_rotation_flag, valid_rotation_flag;
bool_rotation_flag = atoi(rotation_flag);
valid_rotation_flag = (bool_rotation_flag == 0 || bool_rotation_flag == 1);
if (valid_rotation_flag) {
need_rotation = bool_rotation_flag == 1;
grid_getdims(g, &grid_ni, &grid_nj, NULL);
if (need_rotation == 1 && grid_angle == NULL)
enkf_quit("reader_xy_gridded_hfradar(): %s cannot rotate vectors without ANGLE parameter defined within grid prm file",fname);
enkf_printf("\t#Rotation of vectors enabled\n");
}
else
enkf_quit("reader_xy_gridded_hfradar(): %s invalid ROTATION parameter. Need to be a boolean digit");
}
ncw_open(fname, NC_NOWRITE, &ncid);
ncw_inq_varid(ncid, varname, &varid_var);
ncw_inq_vardims(ncid, varid_var, 3, &ndim_var, dimlen_var);
if (ndim_var == 3) {
int dimid[3];
size_t nr;
ncw_inq_vardimid(ncid, varid_var, dimid);
ncw_inq_dimlen(ncid, dimid[0], &nr);
if (nr != 1)
enkf_quit("reader_xy_gridded(): %d records (currently only one is allowed)", nr);
n_var = dimlen_var[1] * dimlen_var[2];
} else if (ndim_var == 2) {
if (nc_hasunlimdim(ncid))
enkf_quit("reader_xy_gridded(): %s: %s: not enough spatial dimensions (must be 2)", fname, varname);
n_var = dimlen_var[0] * dimlen_var[1];
} else if (ndim_var != 2)
enkf_quit("reader_xy_gridded(): %s: # dimensions = %d (must be 2 or 3 with only one record)", fname, ndim_var);
if (lonname != NULL)
ncw_inq_varid(ncid, lonname, &varid_lon);
else if (ncw_var_exists(ncid, "lon"))
ncw_inq_varid(ncid, "lon", &varid_lon);
else if (ncw_var_exists(ncid, "longitude"))
ncw_inq_varid(ncid, "longitude", &varid_lon);
else if (ncw_var_exists(ncid, "LONGITUDE"))
ncw_inq_varid(ncid, "LONGITUDE", &varid_lon);
else
enkf_quit("reader_xy_gridded(): %s: could not find longitude variable", fname);
ncw_inq_vardims(ncid, varid_lon, 2, &ndim_xy, dimlen_xy);
if (ndim_xy == 1) {
iscurv = 0;
ni = dimlen_xy[0];
} else if (ndim_xy == 2) {
iscurv = 1;
ni = dimlen_xy[1];
nj = dimlen_xy[0];
} else
enkf_quit("reader_xy_gridded(): %s: coordinate variable \"%s\" has neither 1 or 2 dimensions", fname, lonname);
if (latname != NULL)
ncw_inq_varid(ncid, latname, &varid_lat);
else if (ncw_var_exists(ncid, "lat"))
ncw_inq_varid(ncid, "lat", &varid_lat);
else if (ncw_var_exists(ncid, "latitude"))
ncw_inq_varid(ncid, "latitude", &varid_lat);
else if (ncw_var_exists(ncid, "LATITUDE"))
ncw_inq_varid(ncid, "LATITUDE", &varid_lat);
else
enkf_quit("reader_xy_gridded(): %s: could not find latitude variable", fname);
if (iscurv == 0) {
ncw_check_varndims(ncid, varid_lat, 1);
ncw_inq_vardims(ncid, varid_lat, 1, NULL, &nj);
} else
ncw_check_vardims(ncid, varid_lat, 2, dimlen_xy);
enkf_printf(" (ni, nj) = (%u, %u)\n", ni, nj);
n = ni * nj;
if (n != n_var)
enkf_quit("reader_xy_gridded(): %s: dimensions of variable \"%s\" do not match coordinate dimensions", fname, varname);
if (dimlen_var[ndim_var - 1] != ni)
enkf_quit("reader_xy_gridded(): %s: %s: longitude must be the inner coordinate", fname, varname);
if (iscurv == 0) {
lon = malloc(ni * sizeof(double));
lat = malloc(nj * sizeof(double));
} else {
lon = malloc(n * sizeof(double));
lat = malloc(n * sizeof(double));
}
ncw_get_var_double(ncid, varid_lon, lon);
ncw_get_var_double(ncid, varid_lat, lat);
var = malloc(n * sizeof(float));
ncw_get_var_float(ncid, varid_var, var);
if (ncw_att_exists(ncid, varid_var, "add_offset")) {
ncw_get_att_float(ncid, varid_var, "add_offset", &var_add_offset);
ncw_get_att_float(ncid, varid_var, "scale_factor", &var_scale_factor);
}
if (ncw_att_exists(ncid, varid_var, "_FillValue"))
ncw_get_att_float(ncid, varid_var, "_FillValue", &var_fill_value);
if (gdopname != NULL)
ncw_inq_varid(ncid, gdopname, &varid_gdop);
else if (ncw_var_exists(ncid, "GDOP"))
ncw_inq_varid(ncid, "GDOP", &varid_gdop);
if (varid_gdop >= 0) {
gdop = malloc(n * sizeof(float));
ncw_get_var_float(ncid, varid_gdop, gdop);
float gdop_fill_value, gdop_add_offset, gdop_scale_factor;
if (ncw_att_exists(ncid, varid_gdop, "_FillValue"))
ncw_get_att_float(ncid, varid_gdop, "_FillValue", &gdop_fill_value);
if (ncw_att_exists(ncid, varid_gdop, "add_offset")) {
ncw_get_att_float(ncid, varid_gdop, "add_offset", &gdop_add_offset);
ncw_get_att_float(ncid, varid_gdop, "scale_factor", &gdop_scale_factor);
}
}
if (npointsname_1 != NULL)
ncw_inq_varid(ncid, npointsname_1, &varid_npoints_1);
else if (ncw_var_exists(ncid, "NOBS1"))
ncw_inq_varid(ncid, "NOBS1", &varid_npoints_1);
if (varid_npoints_1 >= 0) {
npoints_1 = malloc(n * sizeof(short));
ncw_get_var_short(ncid, varid_npoints_1, npoints_1);
}
if (npointsname_2 != NULL)
ncw_inq_varid(ncid, npointsname_2, &varid_npoints_2);
else if (ncw_var_exists(ncid, "NOBS2"))
ncw_inq_varid(ncid, "NOBS2", &varid_npoints_2);
if (varid_npoints_2 >= 0) {
npoints_2 = malloc(n * sizeof(short));
ncw_get_var_short(ncid, varid_npoints_2, npoints_2);
}
if (need_rotation == 1) {
if (u_varname != NULL )
ncw_inq_varid(ncid, u_varname, &varid_u);
else if (ncw_var_exists(ncid, "UCUR")) {
ncw_inq_varid(ncid, "UCUR", &varid_u);
u_varname = "UCUR";
}
if (varid_u >= 0) {
u_var = malloc(n * sizeof(float));
ncw_get_var_float(ncid,varid_u,u_var);
if (ncw_att_exists(ncid,varid_u, "_FillValue"))
ncw_get_att_float(ncid, varid_u, "_FillValue", &u_var_fill_value);
if (ncw_att_exists(ncid,varid_u,"add_offset")) {
ncw_get_att_float(ncid, varid_u, "add_offset", &u_var_add_offset);
ncw_get_att_float(ncid, varid_u, "scale_factor", &u_var_scale_factor);
}
}
else
enkf_quit("reader_xy_gridded(): %s: Variable %s not found.",fname, u_varname);
if (v_varname != NULL)
ncw_inq_varid(ncid, v_varname, &varid_v);
else if (ncw_var_exists(ncid, "VCUR")) {
ncw_inq_varid(ncid, "VCUR", &varid_v);
v_varname = "VCUR";
}
if (varid_v >= 0) {
v_var = malloc(n * sizeof(float));
ncw_get_var_float(ncid,varid_v,v_var);
if (ncw_att_exists(ncid,varid_v, "_FillValue"))
ncw_get_att_float(ncid,varid_v, "_FillValue", &v_var_fill_value);
if (ncw_att_exists(ncid,varid_v,"add_offset")) {
ncw_get_att_float(ncid, varid_v, "add_offset", &v_var_add_offset);
ncw_get_att_float(ncid, varid_v, "scale_factor", &v_var_scale_factor);
}
}
else
enkf_quit("reader_xy_gridded(): %s: Variable %s not found.",fname, v_varname);
}
if (stdname != NULL)
ncw_inq_varid(ncid, stdname, &varid_std);
else if (ncw_var_exists(ncid, "std"))
ncw_inq_varid(ncid, "std", &varid_std);
if (varid_std >= 0) {
std = malloc(n * sizeof(float));
ncw_get_var_float(ncid, varid_std, std);
if (ncw_att_exists(ncid, varid_std, "_FillValue"))
ncw_get_att_float(ncid, varid_std, "_FillValue", &std_fill_value);
if (ncw_att_exists(ncid, varid_std, "add_offset")) {
ncw_get_att_float(ncid, varid_std, "add_offset", &std_add_offset);
ncw_get_att_float(ncid, varid_std, "scale_factor", &std_scale_factor);
}
}
if (estdname != NULL)
ncw_inq_varid(ncid, estdname, &varid_estd);
else if (ncw_var_exists(ncid, "error_std"))
ncw_inq_varid(ncid, "error_std", &varid_estd);
if (varid_estd >= 0) {
estd = malloc(n * sizeof(float));
ncw_get_var_float(ncid, varid_estd, estd);
if (ncw_att_exists(ncid, varid_estd, "_FillValue"))
ncw_get_att_float(ncid, varid_estd, "_FillValue", &estd_fill_value);
if (ncw_att_exists(ncid, varid_estd, "add_offset")) {
ncw_get_att_float(ncid, varid_estd, "add_offset", &estd_add_offset);
ncw_get_att_float(ncid, varid_estd, "scale_factor", &estd_scale_factor);
}
}
if (std == NULL && estd == NULL)
if (ncw_att_exists(ncid, varid_var, "error_std")) {
ncw_check_attlen(ncid, varid_var, "error_std", 1);
ncw_get_att_double(ncid, varid_var, "error_std", &var_estd);
}
if (u_stdvarname != NULL)
ncw_inq_varid(ncid, u_stdvarname, &varid_u_std);
else if (ncw_var_exists(ncid, "UCUR_sd"))
ncw_inq_varid(ncid, "UCUR_sd", &varid_u_std);
if (varid_u_std >= 0) {
u_std = malloc(n * sizeof(float));
ncw_get_var_float(ncid, varid_u_std, u_std);
if (ncw_att_exists(ncid, varid_u_std, "_FillValue"))
ncw_get_att_float(ncid, varid_u_std, "_FillValue", &u_std_fill_value);
if (ncw_att_exists(ncid, varid_u_std, "add_offset")) {
ncw_get_att_float(ncid, varid_u_std, "add_offset", &u_std_add_offset);
ncw_get_att_float(ncid, varid_u_std, "scale_factor", &u_std_scale_factor);
}
}
if (v_stdvarname != NULL)
ncw_inq_varid(ncid, v_stdvarname, &varid_v_std);
else if (ncw_var_exists(ncid, "vcur_sd"))
ncw_inq_varid(ncid, "vcur_sd", &varid_v_std);
if (varid_v_std >= 0) {
v_std = malloc(n * sizeof(float));
ncw_get_var_float(ncid, varid_v_std, v_std);
if (ncw_att_exists(ncid, varid_v_std, "_FillValue"))
ncw_get_att_float(ncid, varid_v_std, "_FillValue", &v_std_fill_value);
if (ncw_att_exists(ncid, varid_v_std, "add_offset")) {
ncw_get_att_float(ncid, varid_v_std, "add_offset", &v_std_add_offset);
ncw_get_att_float(ncid, varid_v_std, "scale_factor", &v_std_scale_factor);
}
}
if (qcflagname != NULL) {
ncw_inq_varid(ncid, qcflagname, &varid_qcflag);
qcflag = malloc(n * sizeof(int32_t));
ncw_get_var_int(ncid, varid_qcflag, qcflag);
}
if (u_qcflagname != NULL)
ncw_inq_varid(ncid, u_qcflagname, &varid_u_qcflag);
else if (ncw_var_exists(ncid, "UCUR_quality_control"))
ncw_inq_varid(ncid, "UCUR_quality_control", &varid_u_qcflag);
if (varid_u_qcflag >= 0) {
u_qcflag = malloc(n * sizeof(int32_t));
ncw_get_var_int(ncid, varid_u_qcflag, u_qcflag);
}
if (v_qcflagname != NULL)
ncw_inq_varid(ncid, v_qcflagname, &varid_v_qcflag);
else if (ncw_var_exists(ncid, "VCUR_quality_control"))
ncw_inq_varid(ncid, "VCUR_quality_control", &varid_v_qcflag);
if (varid_v_qcflag >= 0) {
v_qcflag = malloc(n * sizeof(int32_t));
ncw_get_var_int(ncid, varid_v_qcflag, v_qcflag);
}
if (timename != NULL)
ncw_inq_varid(ncid, timename, &varid_time);
else if (ncw_var_exists(ncid, "time"))
ncw_inq_varid(ncid, "time", &varid_time);
else if (ncw_var_exists(ncid, "TIME"))
ncw_inq_varid(ncid, "TIME", &varid_time);
else {
enkf_printf(" reader_xy_gridded(): %s: no TIME variable\n", fname);
have_time = 0;
}
if (have_time) {
int timendims;
int timedimids[NC_MAX_DIMS];
size_t timelen = 1;
ncw_inq_varndims(ncid, varid_time, &timendims);
ncw_inq_vardimid(ncid, varid_time, timedimids);
for (i = 0; i < timendims; ++i) {
size_t dimlen;
ncw_inq_dimlen(ncid, timedimids[i], &dimlen);
timelen *= dimlen;
}
if (timelen == 1) {
singletime = 1;
time = malloc(sizeof(float));
} else {
singletime = 0;
assert(timelen == n);
time = malloc(n * sizeof(float));
}
ncw_get_var_float(ncid, varid_time, time);
if (ncw_att_exists(ncid, varid_time, "_FillValue"))
ncw_get_att_float(ncid, varid_time, "_FillValue", &time_fill_value);
if (ncw_att_exists(ncid, varid_time, "add_offset")) {
ncw_get_att_float(ncid, varid_time, "add_offset", &time_add_offset);
ncw_get_att_float(ncid, varid_time, "scale_factor", &time_scale_factor);
}
ncw_get_att_text(ncid, varid_time, "units", tunits);
tunits_convert(tunits, &tunits_multiple, &tunits_offset);
}
ncw_close(ncid);
nobs_read = 0;
for (i = 0; i < (int) n; ++i) {
observation* o;
obstype* ot;
int invalid_gdop, invalid_npoints1, invalid_npoints2, invalid_var, invalid_std, invalid_estd, invalid_u_var, invalid_v_var, invalid_time;
invalid_gdop = (gdop != NULL && (gdop[i] > 180.0 || gdop[i] < 0.0));
invalid_npoints1 = (npoints_1 != NULL && (npoints_1[i] == 0 || npoints_1[i]< 0));
invalid_npoints2 = (npoints_2 != NULL && (npoints_2[i] == 0 || npoints_2[i] < 0));
invalid_var = var[i] == var_fill_value || isnan(var[i]);
invalid_std = (std != NULL && (std[i] == std_fill_value || isnan(std[i])));
invalid_estd = (estd != NULL && (estd[i] == estd_fill_value || isnan(estd[i])));
invalid_u_var = (u_var != NULL && (u_var[i] == u_var_fill_value || isnan(u_var[i])));
invalid_v_var = (v_var != NULL && (v_var[i] == v_var_fill_value || isnan(v_var[i])));
invalid_time = (have_time && !singletime && (time[i] == time_fill_value || isnan(time[i])));
if (invalid_gdop || invalid_npoints1 || invalid_npoints2 || invalid_var || invalid_std || invalid_estd || invalid_u_var || invalid_v_var || invalid_time)
continue;
if (qcflag != NULL) {
/* general qcflags has precedence in discarding obs*/
if ( (qcflagvals != (qcflagvals | 1<<qcflag[i])) || (u_qcflag != NULL && (qcflagvals != (qcflagvals | 1<<u_qcflag[i]))) || (v_qcflag != NULL && (qcflagvals != (qcflagvals | 1<<v_qcflag[i]))) )
continue;
}
/* [u,v]_qcflags has precedence in values. */
if (u_qcflagname != NULL && v_qcflagname != NULL) {
if ( (u_qcflag != NULL && (qcflagvals != (qcflagvals | 1<<u_qcflag[i]))) || (v_qcflag != NULL && (qcflagvals != (qcflagvals | 1<<v_qcflag[i]))) )
continue;
} else if (u_qcflagname != NULL) {
if (u_qcflag != NULL && (qcflagvals != (qcflagvals | 1<<u_qcflag[i])))
continue;
} else if (v_qcflagname != NULL) {
if (v_qcflag != NULL && (qcflagvals != (qcflagvals | 1<<v_qcflag[i])))
continue;
}
nobs_read++;
obs_checkalloc(obs);
o = &obs->data[obs->nobs];
o->product = st_findindexbystring(obs->products, meta->product);
assert(o->product >= 0);
o->type = obstype_getid(obs->nobstypes, obs->obstypes, meta->type, 1);
ot = &obs->obstypes[o->type];
o->instrument = st_add_ifabsent(obs->instruments, instrument, -1);
o->id = obs->nobs;
o->fid = fid;
o->batch = 0;
/* Shifted the reading order for HF-Radar to obtain indexes */
if (iscurv == 0) {
o->lon = lon[i % ni];
o->lat = lat[i / ni];
} else {
o->lon = lon[i];
o->lat = lat[i];
}
o->depth = 0.0;
o->fk = (double) ksurf;
o->model_depth = NAN; /* set in obs_add() */
o->status = grid_xy2fij(g, o->lon, o->lat, &o->fi, &o->fj);
if (!obs->allobs && o->status == STATUS_OUTSIDEGRID)
continue;
if ((o->status == STATUS_OK) && (o->lon <= ot->xmin || o->lon >= ot->xmax || o->lat <= ot->ymin || o->lat >= ot->ymax))
o->status = STATUS_OUTSIDEOBSDOMAIN;
if (need_rotation == 1) {
double zonal, meridional, oangle;
if (!isnan(u_var_add_offset))
zonal = u_var[i] * u_var_scale_factor + u_var_add_offset + varshift + u_varshift;
else
zonal = u_var[i];
if (!isnan(v_var_add_offset))
meridional = v_var[i] * v_var_scale_factor + v_var_add_offset + varshift + u_varshift;
else
meridional = v_var[i];
oangle = interpolate2d(o->fi, o-> fj, grid_ni, grid_nj, grid_angle, numlevels, isperiodic_i);
if (strcmp(varname,u_varname) == 0)
o->value = zonal*cos(oangle) - meridional*sin(oangle);
if (strcmp(varname,v_varname) == 0)
o->value = zonal*sin(oangle) + meridional*cos(oangle);
}
else {
if (!isnan(var_add_offset))
o->value = (double) (var[i] * var_scale_factor + var_add_offset + varshift);
else
o->value = (double) (var[i] + varshift);
}
if (estd == NULL && std == NULL){
if (!isnan(var_estd))
o->std = var_estd;
}
else {
if (std == NULL)
o->std = 0.0;
else {
if (!isnan(std_add_offset))
o->std = (double) (std[i] * std_scale_factor + std_add_offset);
else
o->std = (double) std[i];
}
if (estd != NULL) {
if (!isnan(estd_add_offset)) {
double std2 = (double) (estd[i] * estd_scale_factor + estd_add_offset);
o->std = (o->std > std2) ? o->std : std2;
} else
o->std = (o->std > estd[i]) ? o->std : estd[i];
}
}
if (have_time) {
float t = (singletime) ? time[0] : time[i];
if (!isnan(time_add_offset))
o->date = (double) (t * time_scale_factor + time_add_offset) * tunits_multiple + tunits_offset;
else
o->date = (double) t* tunits_multiple + tunits_offset;
} else
o->date = NAN;
o->aux = -1;
obs->nobs++;
}
enkf_printf(" nobs = %d\n", nobs_read);
free(lon);
free(lat);
free(var);
if (gdop != NULL)
free(gdop);
if (npoints_1 != NULL)
free(npoints_1);
if (npoints_2 != NULL)
free(npoints_2);
if (u_var != NULL)
free(u_var);
if (v_var != NULL)
free(v_var);
if (std != NULL)
free(std);
if (estd != NULL)
free(estd);
if (u_std != NULL)
free(u_std);
if (v_std != NULL)
free(v_std);
if (qcflag != NULL)
free(qcflag);
if (u_qcflag != NULL)
free(u_qcflag);
if (v_qcflag != NULL)
free(v_qcflag);
if (time != NULL)
free(time);
}
void EngineState::periodicFastCallback(DECLARE_ENGINE_PARAMETER_F) {
int rpm = ENGINE(rpmCalculator.rpmValue);
efitick_t nowNt = getTimeNowNt();
if (isCrankingR(rpm)) {
crankingTime = nowNt;
} else {
timeSinceCranking = nowNt - crankingTime;
}
sparkDwell = getSparkDwell(rpm PASS_ENGINE_PARAMETER);
dwellAngle = sparkDwell / getOneDegreeTimeMs(rpm);
// todo: move this into slow callback, no reason for IAT corr to be here
iatFuelCorrection = getIatCorrection(iat PASS_ENGINE_PARAMETER);
// todo: move this into slow callback, no reason for CLT corr to be here
if (boardConfiguration->useWarmupPidAfr && clt < engineConfiguration->warmupAfrThreshold) {
if (rpm < 200) {
cltFuelCorrection = 1;
warmupAfrPid.reset();
} else {
cltFuelCorrection = warmupAfrPid.getValue(warmupTargetAfr, getAfr(PASS_ENGINE_PARAMETER_F), 1);
}
#if ! EFI_UNIT_TEST || defined(__DOXYGEN__)
if (engineConfiguration->debugMode == WARMUP_ENRICH) {
tsOutputChannels.debugFloatField1 = warmupTargetAfr;
warmupAfrPid.postState(&tsOutputChannels);
}
#endif
} else {
cltFuelCorrection = getCltFuelCorrection(clt PASS_ENGINE_PARAMETER);
}
cltTimingCorrection = getCltTimingCorrection(clt PASS_ENGINE_PARAMETER);
engineNoiseHipLevel = interpolate2d(rpm, engineConfiguration->knockNoiseRpmBins,
engineConfiguration->knockNoise, ENGINE_NOISE_CURVE_SIZE);
baroCorrection = getBaroCorrection(PASS_ENGINE_PARAMETER_F);
injectionOffset = getinjectionOffset(rpm PASS_ENGINE_PARAMETER);
float engineLoad = getEngineLoadT(PASS_ENGINE_PARAMETER_F);
timingAdvance = getAdvance(rpm, engineLoad PASS_ENGINE_PARAMETER);
if (engineConfiguration->fuelAlgorithm == LM_SPEED_DENSITY) {
float coolantC = ENGINE(engineState.clt);
float intakeC = ENGINE(engineState.iat);
float tps = getTPS(PASS_ENGINE_PARAMETER_F);
tChargeK = convertCelsiusToKelvin(getTCharge(rpm, tps, coolantC, intakeC PASS_ENGINE_PARAMETER));
float map = getMap();
/**
* *0.01 because of https://sourceforge.net/p/rusefi/tickets/153/
*/
currentVE = baroCorrection * veMap.getValue(rpm, map) * 0.01;
targetAFR = afrMap.getValue(rpm, map);
} else {
baseTableFuel = getBaseTableFuel(engineConfiguration, rpm, engineLoad);
}
}
