added debug class for time measurment

This commit is contained in:
2021-11-25 15:01:20 +01:00
parent c741546ba1
commit a9f34b0054
7 changed files with 67 additions and 42 deletions
+2 -2
View File
@@ -51,7 +51,7 @@ void MoveControl::runMoveControl() {
static uint32_t functioncalls = 0;
functioncalls++;
if (functioncalls % 20 == 0) {
if (functioncalls % 50 == 0) {
char str[128];
sprintf(str, "x_speed: %3.2f, rotation_speed: %3.2f, left: %3.2f, right: %3.2f",
this->x_speed, this->rotation_speed, this->wheelspeed_left,
@@ -73,7 +73,7 @@ void MoveControl::setSpeed(double speed) {
}
void MoveControl::setRotationspeed(double speed) {
if (speed < 0.2 && speed > -0.2)
if (speed < 0.7 && speed > -0.7)
this->rotation_speed = 0;
else
this->rotation_speed = speed;