eu07/maszyna
1
0
Fork 0
mirror of https://github.com/MaSzyna-EU07/maszyna.git synced 2026-03-22 15:05:03 +01:00
Code Issues Packages Projects Releases 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)
return;
float forward = t->Occupied()->AccSVBased;
float lateral = t->Occupied()->AccN;
float vertical = t->Occupied()->AccVert;
float velocity = t->Occupied()->V;
float forward = t->Occupied()->AccSVBased / 9.81;
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));
}