eu07/maszyna
16
0
Fork 0
mirror of https://github.com/MaSzyna-EU07/maszyna.git synced 2026-07-22 08:09:19 +02:00
Code Issues 123 Wiki Activity

tmp

Browse Source
This commit is contained in:
milek7
2018-01-16 15:53:33 +01:00
parent ccd118d97e
commit 416d3a2e0e
1 changed files with 11 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

14
motiontelemetry.cpp
View File

@@ -58,9 +58,17 @@ void motiontelemetry::update()
if (!t) if (!t)
return; return;
float forward = t->Occupied()->AccSVBased; float velocity = t->Occupied()->V;
float lateral = t->Occupied()->AccN; float forward = t->Occupied()->AccSVBased / 9.81;
float vertical = t->Occupied()->AccVert; float lateral = t->Occupied()->AccN / 9.81;
float vertical = t->Occupied()->AccVert / 9.81 + 1.0;
if (t->Occupied()->ActiveCab < 0)
{
velocity *= -1;
forward *= -1;
lateral *= -1;
}
WriteLog("forward: " + std::to_string(forward) + ", lateral: " + std::to_string(lateral) + ", vertical: " + std::to_string(vertical)); WriteLog("forward: " + std::to_string(forward) + ", lateral: " + std::to_string(lateral) + ", vertical: " + std::to_string(vertical));
} }