#define KI 0.12
#define KD 0.0
#define PID_T 0.01
// wheel diameter=12cm, encoder=48cpr, gear ratio=1:47
// STEP_PER_M = 48*47/(d*pi)
// Left real diameter: 0.12808, Right real diameter: 0.121
#define KI 0.12
#define KD 0.0
#define PID_T 0.01
// wheel diameter=12cm, encoder=48cpr, gear ratio=1:47
// STEP_PER_M = 48*47/(d*pi)
// Left real diameter: 0.12808, Right real diameter: 0.121