Use sensible default values for k_i and k_d

controller/src/logic/pid_control.rs

@@ -9,9 +9,9 @@ type PidUnit = Fixed<8>;
 // Those coefficients are to be intepreted as `PidUnit` values.
 // For example, if `PidUnit` is `Fixed<8>`, a value of 0x40 is
 // in fact 0x40 ÷ (1 << 8) = 0.25.
-pub static K_P: AtomicI32 = AtomicI32::new(0x40);
-pub static K_I: AtomicI32 = AtomicI32::new(0);
-pub static K_D: AtomicI32 = AtomicI32::new(0);
+pub static K_P: AtomicI32 = AtomicI32::new(0x40); // 0.25
+pub static K_I: AtomicI32 = AtomicI32::new(0x03); // 0.01171875
+pub static K_D: AtomicI32 = AtomicI32::new(-0x01); // -0.00390625
 
 static CONTROLLED_MODE: AtomicBool = AtomicBool::new(false);
 static LEFT_SPEED: AtomicI16 = AtomicI16::new(0);