tuning
This commit is contained in:
parent
1a388de3fe
commit
be3c8a359b
2 changed files with 3 additions and 3 deletions
|
|
@ -13,7 +13,7 @@ const float DEG_CM = (PI*WHEEL_DIAMETER) / 360.0;
|
|||
|
||||
//const float FORWARD_DISTANCE = 73.0; // cm
|
||||
const float FORWARD_DISTANCE = 50.0; // cm
|
||||
const float TURN_AMOUNT = 210.0; // degrees
|
||||
const float TURN_AMOUNT = 180.0; // degrees
|
||||
const float TURN_DISTANCE = (TURN_AMOUNT / 360.0) * WHEEL_TO_WHEEL * PI;
|
||||
|
||||
const float KP = 1.40; // proportional
|
||||
|
|
|
|||
|
|
@ -49,9 +49,9 @@ void setup() {
|
|||
|
||||
Wire.begin(); // INIT ARDUINO UNO AS I2C CONTROLLER
|
||||
|
||||
left_motor.tune_pos_pid(0.05, 0.014, 0.008);
|
||||
left_motor.tune_pos_pid(0.4, 0.024, 0.008);
|
||||
delay(1);
|
||||
right_motor.tune_pos_pid(0.05, 0.014, 0.008);
|
||||
right_motor.tune_pos_pid(0.4, 0.024, 0.008);
|
||||
delay(1);
|
||||
left_motor.tune_vel_pid(Kv, KP,KI,KD);
|
||||
delay(1);
|
||||
|
|
|
|||
Loading…
Reference in a new issue