small fixes

This commit is contained in:
2023-01-09 15:36:03 +01:00
parent 534b1f93d0
commit 75a1eb749c
2 changed files with 5 additions and 16 deletions
+2 -11
View File
@@ -121,12 +121,12 @@ void MoveControl::setRotationSpeed(double speed) {
}
void MoveControl::setRawPowerLeft(int16_t power) {
if (power <= 100 && power >= 100)
if (power <= 100 && power >= -100)
this->rawPowerLeft = power;
}
void MoveControl::setRawPowerRight(int16_t power) {
if (power <= 100 && power >= 100)
if (power <= 100 && power >= -100)
this->rawPowerRight = power;
}
@@ -168,15 +168,6 @@ void MoveControl::regulateMotors() {
case DrivingStatus::stop :
this->left_motor->setTargetPower(0);
this->right_motor->setTargetPower(0);
// Serial.println("in stop MoveControl::regulateMotors");
// if (abs(left_speedometer->getSpeed()) > 0.2) {
// Serial.printf("Left Motor Target: %d, Ist: %d\n", this->left_motor->getTargetPower(), this->left_motor->getPower());
// Serial.printf("Left Speedometer speed: %f\n", this->left_speedometer->getSpeed());
// }
// if (abs(right_speedometer->getSpeed()) > 0.2) {
// Serial.printf("Right Motor Target: %d, Ist: %d\n", this->right_motor->getTargetPower(), this->right_motor->getPower());
// Serial.printf("Right Speedometer speed: %f\n", this->right_speedometer->getSpeed());
// }
break;
case DrivingStatus::drive :