CPL/Simulator
6
0
Fork 2
Code Issues 1 Pull Requests Actions Packages Projects Releases Activity

Update RealMode.cs

Browse Source
This commit is contained in:
Sergey Sklyarov
2025-07-08 17:57:11 +03:00
parent b8b3140cea
commit 518c19fd2b
1 changed files with 84 additions and 81 deletions
Download Patch File Download Diff File Expand all files Collapse all files

165
DroneSimulator/RealMode.cs
View File

@ -162,6 +162,24 @@ namespace DroneSimulator
public void Update(Vector3 value, uint time)
{
Vector3 v = value;
int noise = (int)(Noise * 1000);
v.X += ((float)rand.Next(-noise, noise)) / 1000;
v.Y += ((float)rand.Next(-noise, noise)) / 1000;
v.Z += ((float)rand.Next(-noise, noise)) / 1000;
uint clock = (uint)(Lateness * 1000);
uint tick = time - last;
last = time;
while (tick != 0)
{
tick--;
laten[index++] = v;
if (index >= clock) index = 0;
}
if (!Enable)
{
result = Vector3.NaN;
@ -176,29 +194,12 @@ namespace DroneSimulator
return;
}
int noise = (int)(Noise * 1000);
value.X += ((float)rand.Next(-noise, noise)) / 1000;
value.Y += ((float)rand.Next(-noise, noise)) / 1000;
value.Z += ((float)rand.Next(-noise, noise)) / 1000;
uint clock = (uint)(Lateness * 1000);
uint tick = time - last;
last = time;
while (tick != 0)
{
tick--;
laten[index++] = value;
if (index >= clock) index = 0;
}
value = laten[index];
v = laten[index];
uint freq = 1000 / Freq;
if (timer + freq <= time)
{
result = value;
result = v;
timer = time;
}
}
@ -227,9 +228,24 @@ namespace DroneSimulator
public void Update(float value, uint time)
{
//value = Pressure - value * 12.15f;
value = Pressure * MathF.Exp(-0.02896f * 9.81f * value / (8.314f * (Temperature + 273.15f)));
float v = value;
int noise = (int)(Noise * 1000);
v += ((float)rand.Next(-noise, noise)) / 1000;
uint clock = (uint)(Lateness * 1000);
uint tick = time - last;
last = time;
while (tick != 0)
{
tick--;
laten[index++] = v;
if (index >= clock) index = 0;
}
if (!Enable)
{
result = float.NaN;
@ -241,30 +257,15 @@ namespace DroneSimulator
{
result = value;
timer = time;
return;
return;
}
int noise = (int)(Noise * 1000);
value += ((float)rand.Next(-noise, noise)) / 1000;
uint clock = (uint)(Lateness * 1000);
uint tick = time - last;
last = time;
while (tick != 0)
{
tick--;
laten[index++] = value;
if (index >= clock) index = 0;
}
value = laten[index];
v = laten[index];
uint freq = 1000 / Freq;
if (timer + freq <= time)
{
result = value;
result = v;
timer = time;
}
}
@ -296,6 +297,27 @@ namespace DroneSimulator
{
value *= Lens;
Vector2 v = value;
if (Range > MaxHeight) v = Vector2.Zero;
else
{
int noise = (int)(Noise * 1000);
v.X += ((float)rand.Next(-noise, noise)) / 1000;
v.Y += ((float)rand.Next(-noise, noise)) / 1000;
}
uint clock = (uint)(Lateness * 1000);
uint tick = time - last;
last = time;
while (tick != 0)
{
tick--;
laten[index++] = v;
if (index >= clock) index = 0;
}
if (!Enable)
{
result = Vector2.NaN;
@ -310,32 +332,12 @@ namespace DroneSimulator
return true;
}
if (Range > MaxHeight) value = Vector2.Zero;
else
{
int noise = (int)(Noise * 1000);
value.X += ((float)rand.Next(-noise, noise)) / 1000;
value.Y += ((float)rand.Next(-noise, noise)) / 1000;
}
uint clock = (uint)(Lateness * 1000);
uint tick = time - last;
last = time;
while (tick != 0)
{
tick--;
laten[index++] = value;
if (index >= clock) index = 0;
}
value = laten[index];
v = laten[index];
uint freq = 1000 / Freq;
if (timer + freq <= time)
{
result = value;
result = v;
timer = time;
return true;
}
@ -366,6 +368,26 @@ namespace DroneSimulator
public void Update(float value, uint time)
{
float v = value;
if (v > MaxHeight) v = -1;
else
{
int noise = (int)(Noise * 1000);
v += ((float)rand.Next(-noise, noise)) / 1000;
}
uint clock = (uint)(Lateness * 1000);
uint tick = time - last;
last = time;
while (tick != 0)
{
tick--;
laten[index++] = v;
if (index >= clock) index = 0;
}
if (!Enable)
{
result = float.NaN;
@ -380,31 +402,12 @@ namespace DroneSimulator
return;
}
if (value > MaxHeight) value = -1;
else
{
int noise = (int)(Noise * 1000);
value += ((float)rand.Next(-noise, noise)) / 1000;
}
uint clock = (uint)(Lateness * 1000);
uint tick = time - last;
last = time;
while (tick != 0)
{
tick--;
laten[index++] = value;
if (index >= clock) index = 0;
}
value = laten[index];
v = laten[index];
uint freq = 1000 / Freq;
if (timer + freq <= time)
{
result = value;
result = v;
timer = time;
}
}