// converting right motor speed to motor value
if (speedR <= maxSpeedOneR) {
- mvR = speedR / maxSpeedOneR * 5;
+ mvR = speedR / (maxSpeedOneR * 5);
} else if (speedR <= maxSpeedTwoR) {
- mvR = speedR / maxSpeedTwoR * 2.5;
+ mvR = speedR / (maxSpeedTwoR * 2.5);
} else if (speedR <= maxSpeedThreeR) {
- mvR = speedR / maxSpeedThreeR * 1.66;
+ mvR = speedR / (maxSpeedThreeR * 1.66);
}
// converting left motor speed to motor value
if (speedL <= maxSpeedOneL) {
- mvL = speedL / maxSpeedOneL * 5;
+ mvL = speedL / (maxSpeedOneL * 5);
} else if (speedL <= maxSpeedTwoL) {
- mvL = speedL / maxSpeedTwoL * 2.5;
+ mvL = speedL / (maxSpeedTwoL * 2.5);
} else if (speedL <= maxSpeedThreeL) {
- mvL = speedL / maxSpeedThreeL * 1.66;
+ mvL = speedL / (maxSpeedThreeL * 1.66);
}
// Setting motors at new motor values