アナログスティックの傾いてる角度を算出し、それにおうじてオムニの進む方向をコントロールしています。関数の使い回しはご自由にどうぞ。

Dependencies:   HMC6352 mbed

Revision:
16:2bb07173f8bf
Parent:
15:02d4a5eed16c
--- a/main.cpp	Wed Mar 18 05:14:45 2015 +0000
+++ b/main.cpp	Sun Mar 29 00:52:59 2015 +0000
@@ -207,16 +207,16 @@
                 mo1 = 1;
                 mo2 = 1;
                 mo3 = 1;
-                mop1 = (fabs(aval)/180);
-                mop2 = (fabs(aval)/180);
-                mop3 = (fabs(aval)/180);
+                mop1 = 0.5;
+                mop2 = 0.5;
+                mop3 = 0.5;
             }else if(hun == 1){
                 mo1 = 2;
                 mo2 = 2;
                 mo3 = 2;
-                mop1 = (fabs(aval)/180);
-                mop2 = (fabs(aval)/180);
-                mop3 = (fabs(aval)/180);
+                mop1 = 0.5;
+                mop2 = 0.5;
+                mop3 = 0.5;
             }else {
                 mo1 = 0;
                 mo2 = 0;