added fixed interval smoothing

This commit is contained in:
toni
2016-03-17 19:24:45 +01:00
parent 8d2be0f8a0
commit 89bb0b8b7a
17 changed files with 1010 additions and 137 deletions

View File

@@ -87,6 +87,9 @@ public:
// update the old heading and the other old values
//p.state.walkState.heading = p.state.heading;
if(!(p.state.pOld == p.state.pCur)){
p.state.cumulativeHeading = Angle::getDEG_360(p.state.pOld.x, p.state.pOld.y, p.state.pCur.x, p.state.pCur.y);
}
p.state.pOld = p.state.pCur;