#define PID_T 0.01
// wheel diameter=12cm, encoder=48cpr, gear ratio=1:34, real wheel diameter: 0.12454m
#define STEP_PER_M_AVG 4171.4
#define PID_T 0.01
// wheel diameter=12cm, encoder=48cpr, gear ratio=1:34, real wheel diameter: 0.12454m
#define STEP_PER_M_AVG 4171.4