some pid tuning, correct motor numbers