mirror of
https://github.com/modelec/odo_STM32.git
synced 2026-03-18 21:30:38 +01:00
fix a lot
This commit is contained in:
@@ -61,7 +61,7 @@ public:
|
||||
|
||||
uint32_t lastTick = 0;
|
||||
uint32_t publishLastTick = 0;
|
||||
uint32_t frequencyPublish = 100;
|
||||
uint32_t frequencyPublish = 300;
|
||||
|
||||
float preciseAngleFinal = 0.005f;
|
||||
float preciseAngle = 0.39f;
|
||||
|
||||
@@ -60,10 +60,10 @@ void DiffBot::stop(bool stop)
|
||||
|
||||
void DiffBot::setup()
|
||||
{
|
||||
pidLeft = PID(5.0f, 0.0f, 0.0f, -PWM_MAX, PWM_MAX);
|
||||
pidRight = PID(5.0f, 0.0f, 0.0f, -PWM_MAX, PWM_MAX);
|
||||
pidPos = PID(3.5f, 0.0f, 0.0f, -V_MAX, V_MAX);
|
||||
pidTheta = PID(11.0f, 0.0f, 0.0f, -M_PI, M_PI);
|
||||
pidLeft = PID(7.0f, 0.0f, 0.0f, -PWM_MAX, PWM_MAX);
|
||||
pidRight = PID(7.0f, 0.0f, 0.0f, -PWM_MAX, PWM_MAX);
|
||||
pidPos = PID(6.0f, 0.2f, 0.02f, -V_MAX, V_MAX);
|
||||
pidTheta = PID(15.0f, 0.2f, 0.02f, -M_PI, M_PI);
|
||||
|
||||
prevCountLeft = __HAL_TIM_GET_COUNTER(&htim2);
|
||||
prevCountRight = __HAL_TIM_GET_COUNTER(&htim3);
|
||||
|
||||
Reference in New Issue
Block a user