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

Dependencies:   HMC6352 mbed

Files at this revision

API Documentation at this revision

Comitter:
WAT34
Date:
Sun Mar 29 00:52:59 2015 +0000
Parent:
15:02d4a5eed16c
Commit message:
????????A????????

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file
diff -r 02d4a5eed16c -r 2bb07173f8bf main.cpp
--- 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;