sampleProgram

Dependencies:   QEI accelerator bit_test cyclic_io cyclic_var cylinder event_var limit mbed mecanum motor_drive pid pid_encoder rs422_put sbdbt servo

Fork of 17robo_fuzi by kusano kiyoshige

Revision:
11:bbd999225791
Parent:
9:6486f4b3ac50
--- a/main.cpp	Tue Jul 11 09:39:40 2017 +0000
+++ b/main.cpp	Sun Jul 16 04:11:32 2017 +0000
@@ -65,7 +65,7 @@
     rs422.begin(rs422_baud);
     output_timer.attach(&output, output_period);
     yaw_pid.setup(yaw_Kp, yaw_Ki, yaw_Kd);
-    mecanum.setupdeg(bno055.getYawRad());
+    mecanum.setupdeg(bno055.getYawRad()+180);
     v1.setup(acceleration,output_period);
     v2.setup(acceleration,output_period);
     v3.setup(acceleration,output_period);