added pid settings to menu

This commit is contained in:
2022-01-19 14:55:26 +01:00
parent 241123e6c9
commit 1265cfda5c
20 changed files with 608 additions and 87 deletions
+9
View File
@@ -89,6 +89,15 @@ void MoveControl::setPidTunings(uint8_t side, double p, double i, double d) {
selectedPID->SetTunings(p, i, d);
}
PID* MoveControl::getPID(uint8_t side) {
if (side == 0)
return this->left_pid;
else if (side == 1)
return this->right_pid;
else
return nullptr;
}
void MoveControl::calcTargetWheelSpeed() {
/* original formula:
(1 / r) / 1 b \ / x \ = / Xl \