jakob.kampichler/libcreate
jakob.kampichler/libcreate
1
0
Fork 0
forked from compAIR/libcreate
Code Pull requests Activity

Actually fixed wrap around

Browse source
This commit is contained in:
Bernhard Klauninger 2023-03-15 13:14:06 +01:00 • committed by Konstantin Lampalzer
parent 1bc2d768f7
commit 2c58777e45
1 changed files with 11 additions and 11 deletions
Download patch file Download diff file Expand all files Collapse all files

22
src/create.cpp
View file

@ -157,18 +157,18 @@ namespace create {
int ticksLeft = totalTicksLeft - prevTicksLeft; int ticksLeft = totalTicksLeft - prevTicksLeft;
int ticksRight = totalTicksRight - prevTicksRight; int ticksRight = totalTicksRight - prevTicksRight;
// Handle wrap around // Handle wrap around
if (ticksLeft > 0.9 * util::V_3_MAX_ENCODER_TICKS) { if (ticksLeft > 0.9 * util::V_3_MAX_ENCODER_TICKS) {
ticksLeft = 2 * util::V_3_MAX_ENCODER_TICKS + prevTicksLeft - ticksLeft; ticksLeft -= util::V_3_MAX_ENCODER_TICKS;
} else if (ticksLeft < 0.9 * -util::V_3_MAX_ENCODER_TICKS) { } else if (ticksLeft < -0.9 * util::V_3_MAX_ENCODER_TICKS) {
ticksLeft = util::V_3_MAX_ENCODER_TICKS - prevTicksLeft + util::V_3_MAX_ENCODER_TICKS + ticksLeft; ticksLeft += util::V_3_MAX_ENCODER_TICKS;
} }
if (ticksRight > 0.9 * util::V_3_MAX_ENCODER_TICKS) { if (ticksRight > 0.9 * util::V_3_MAX_ENCODER_TICKS) {
ticksRight = util::V_3_MAX_ENCODER_TICKS + prevTicksRight + util::V_3_MAX_ENCODER_TICKS - ticksRight; ticksRight -= util::V_3_MAX_ENCODER_TICKS;
} else if (ticksLeft < 0.9 * -util::V_3_MAX_ENCODER_TICKS) { } else if (ticksRight < -0.9 * util::V_3_MAX_ENCODER_TICKS) {
ticksRight = util::V_3_MAX_ENCODER_TICKS - prevTicksRight + util::V_3_MAX_ENCODER_TICKS + ticksRight; ticksRight += util::V_3_MAX_ENCODER_TICKS;
} }
prevTicksLeft = totalTicksLeft; prevTicksLeft = totalTicksLeft;
prevTicksRight = totalTicksRight; prevTicksRight = totalTicksRight;