NagaokaRoboticsClub_mbedTeam / Mbed OS NHK2017_octopus2_drive

タコ　駆動側　

Dependencies:   2017NHKpin_config FEP R1307 PID ikarashiMDC omni_wheel

Fork of NHK2017_octopus2 by NagaokaRoboticsClub_mbedTeam

Diff: bot/bot.cpp

Revision:
41:ae6f844facb1
Parent:
39:07180d39a030
Child:
42:00a2261fbd56
--- a/bot/bot.cpp	Thu Oct 19 15:37:28 2017 +0900
+++ b/bot/bot.cpp	Sat Oct 21 14:54:16 2017 +0900
@@ -159,6 +159,20 @@
     }
 }
 
+void Bot::controllDrive4()
+{
+    if(receiveSuccessed) {
+        quadOmni.moveXY(
+                pad.getStick(0),
+                pad.getStick(1),
+                0.0,
+                0.0,
+                -pad.getStick(2)/2.0
+                );
+    } else {
+        quadOmni.moveXY(0, 0, 0);
+    }
+}
 void Bot::controllMech()
 {
     if(receiveSuccessed) {