X-Git-Url: https://defiant.homedns.org/gitweb/?p=ros_wild_thumper.git;a=blobdiff_plain;f=avr%2Fmotor_ctrl%2Fmain.c;h=5c6a667f28449ca59c3ec96890a8726343a1333e;hp=d25271fe945993606b49214d756134f4f01f0049;hb=3bc8d7f92277a953cfcee5781d5875f040d7f028;hpb=1d95fd8a372e93eafd14666c0145b8afcbc14700

diff --git a/avr/motor_ctrl/main.c b/avr/motor_ctrl/main.c
index d25271f..5c6a667 100644
--- a/avr/motor_ctrl/main.c
+++ b/avr/motor_ctrl/main.c
@@ -101,9 +101,9 @@
 #define TWI_RESET	TWCR &= ~((1 << TWSTO) | (1 << TWEN)); TWI_ACK
 #define TWI_NAK		TWCR = (1<<TWINT) | (1<<TWEN) | (1<<TWIE)
 
-#define KP 0.045
-#define KI 2.298
-#define KD 0.0004
+#define KP 0.025
+#define KI 2.3
+#define KD 0.0
 #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