Besttechnology - [FDIII-HC Starter Kit Guide/Chapter4.3 のバックアップの現在との差分(No.3)]

差分を表示
ソースを表示
FDIII-HC Starter Kit Guide/Chapter4.3 へ行く。

--- 3: 2011-07-05 (火) 14:01:53 yoshida
+++ 現: 2013-04-09 (火) 23:46:46 takaboo
@@ Line 1: / Line 1: @@
+TITLE:騒音計のプログラミング
 *プログラミング [#c7bb54c8]
 #ref(SoundMeter_1.png)
-「AX-S1で最大音量を測定し、それに対応した角度へAX-12+のホーンを動かす」というプログラムを作成します。
+「AX-S1で最大音量を測定し、それに対応した角度へAX-12Aのホーンを動かす」というプログラムを作成します。
 **処理の流れを図にする。 [#fac5abab]
 先ず処理の流れを図にします。
 #ref(flow.png)
-AX-S1の最大音量を取得し、それに対応した角度へAX-12+のホーンを動かすを繰り返すだけとなります。
+AX-S1の最大音量を取得し、それに対応した角度へAX-12Aのホーンを動かすを繰り返すだけとなります。
 **準備 [#m074851f]
@@ Line 19: / Line 20: @@
 **バーの開閉から音量最大値の取得へ変更 [#tfcaa108]
 バーの開閉部分を削除し、正面赤外線センサの値の取得を音量最大値の取得へ変更します。
-#ref(gcc_edit_1.png,100%)
+#html{{
+<pre class="brush:c">
+#include <fd.h>
+void main (void) {
+  uint8_t ReadData;
+  fd_SetBeepCondition (FD_BEEP_MMI | FD_BEEP_PACKETERR | FD_BEEP_LOWVOLTAGE | FD_BEEP_BOOTUP);
+  fd_SetUVThreshold (7.4);
+  DX_ChangeBaudrate (1000000);
+  fd_DXSetTorqueLimit (1, 154);
+  while (!fd_rx_buff () && !fd_GetPB ()) {
+    DX_ReadByteData (100, 27, &ReadData, 10, NULL);
+    fd_printf ("%3d\r", ReadData);
+    if (ReadData > 100) {
+      fd_DXSetPosition (1, 300);
+      fd_Wait (2000);
+    } else {
+      fd_DXSetPosition (1, 512);
+    }
+    fd_Wait (10);
+  }
+}
+</pre>
+}}
+#ref(down_arrow.png)
+#html{{
+<pre class="brush:c">
+#include <fd.h>
+void main (void) {
+  uint8_t ReadData;
+  fd_SetBeepCondition (FD_BEEP_MMI | FD_BEEP_PACKETERR | FD_BEEP_LOWVOLTAGE | FD_BEEP_BOOTUP);
+  fd_SetUVThreshold (7.4);
+  DX_ChangeBaudrate (1000000);
+  fd_DXSetTorqueLimit (1, 154);
+  while (!fd_rx_buff () && !fd_GetPB ()) {
+    DX_ReadByteData (100, 36, &ReadData, 10, NULL);
+    fd_printf ("%3d\r", ReadData);
+    fd_Wait (10);
+  }
+}
+</pre>
+}}
 DX_ReadByteDataの第2引数を27から36へ変更します。
 [[AX-S1コントロールテーブル>FDIIICHAPTER1.1#ye0e23e2]]にある通り、音量最大保持値はアドレス36です。
 音量最大保持値はアドレス35の音量測定値の最大値を保持し続けます。
-**アクチュエータのホーンを動かす [#r33f5d9f]
+**AX-12Aのホーンを動かす [#r33f5d9f]
-#ref(gcc_edit_2.png)
+#html{{
-アクチュエータのホーンの角度をメーターに見立て、音量最大保持値に対応した角度にホーンを動かします。
+<pre class="brush:c">
+#include <fd.h>
+void main (void) {
+  uint8_t ReadData;
-アクチュエータのホーンを動かすには、fd_DXSetPosition関数を使います。詳しくは[[Chapter3.3のブザーを鳴らすからバーを開けるに変更&gt;FDIIICHAPTER3.3#o54aa8b3]]を参照して下さい。
+&nbsp; fd_SetBeepCondition (FD_BEEP_MMI | FD_BEEP_PACKETERR | FD_BEEP_LOWVOLTAGE | FD_BEEP_BOOTUP);
+  fd_SetUVThreshold (7.4);
+  DX_ChangeBaudrate (1000000);
-音量最大保持値に対応した角度にアクチュエータのホーンを動かしますので、ゴールポジション=音量最大保持値です。~
+  fd_DXSetTorqueLimit (1, 154);
-音量最大保持値は
- fd_DXReadByteData (100, 36, &ReadData);
+  while (!fd_rx_buff () && !fd_GetPB ()) {
-で変数ReadDataに代入されます。従ってゴールポジションにはReadDataと書きます。
+    DX_ReadByteData (100, 36, &ReadData, 10, NULL);
+    fd_printf ("%3d\r", ReadData);
+    fd_DXSetPosition (1, ReadData);
+    fd_Wait (10);
+  }
+}
+</pre>
+}}
+AX-12Aのホーンの角度をメーターに見立て、音量最大保持値に対応した角度にホーンを動かします。
+AX-12Aのホーンを動かすには、fd_DXSetPosition関数を使います。詳しくは[[Chapter3.3のブザーを鳴らすからバーを開けるに変更>FDIIICHAPTER3.3#o54aa8b3]]を参照して下さい。
+音量最大保持値に対応した角度にAX-12Aのホーンを動かしますので、ゴールポジション=音量最大保持値です。~
+音量最大保持値は変数ReadDataに代入されますので、そのままゴールポジションにReadDataを指定します。
 ReadDataの前に&は付けません。変数の前に&を付けるとその変数のアドレスになります。
 ゴールポジションに書き込むのは、ReadDataのアドレスではなく、ReadDataに入っている値です。
+**ゴールポジションと音量最大保持値のデータ範囲 [#ke591b16]
+#html{{
+<pre class="brush:c">
+#include <fd.h>
+void main (void) {
+  uint8_t ReadData;
+  fd_SetBeepCondition (FD_BEEP_MMI | FD_BEEP_PACKETERR | FD_BEEP_LOWVOLTAGE | FD_BEEP_BOOTUP);
+  fd_SetUVThreshold (7.4);
+  DX_ChangeBaudrate (1000000);
+  fd_DXSetTorqueLimit (1, 154);
+  while (!fd_rx_buff () && !fd_GetPB ()) {
+    DX_ReadByteData (100, 36, &ReadData, 10, NULL);
+    fd_printf ("%3d\r", ReadData);
+    fd_DXSetPosition (1, ReadData * 3);
+    fd_Wait (10);
+  }
+}
+</pre>
+}}
+ゴールポジションのデータの範囲は0~1023でした。
+音量最大保持値のデータ範囲はどうでしょう。
+音量センサの値は[[Chapter2.5の課題>FDIIICHAPTER2.5]]で紹介した通り、128を中心に音がすると音量に応じて上下に揺れます。
+音量最大保持値は音量センサの最大値を保持した値なので、音量最大保持値の範囲は128~255となります。
+ゴールポジションはせっかく0~1023の範囲があるので、音量最大保持値を3倍した値を代入することで、コールポジションの範囲を384~765にします。~
+つまり音量最大保持値が128のときゴールポジションは384、200のとき600、255のとき765になります。
+**音量最大保持値のリセット [#ie242320]
+音量最大保持値は、音量の最大値を保持し続けます。従って一度値が最大の255になると、それ以降は255から変化することはありません。もう一度初めから測定するために音量最大保持値をプッシュボタンでリセットするようにします。
+#html{{
+<pre class="brush:c">
+#include <fd.h>
+void main (void) {
+  uint8_t ReadData;
+  fd_SetBeepCondition (FD_BEEP_MMI | FD_BEEP_PACKETERR | FD_BEEP_LOWVOLTAGE | FD_BEEP_BOOTUP);
+  fd_SetUVThreshold (7.4);
+  DX_ChangeBaudrate (1000000);
+  fd_DXSetTorqueLimit (1, 154);
+  while (!fd_rx_buff ()) {
+    DX_ReadByteData (100, 36, &ReadData, 10, NULL);
+    fd_printf ("%3d\r", ReadData);
+    fd_DXSetPosition (1, ReadData);
+    if (fd_GetPB ()) {
+      DX_WriteByteData (100, 36, 0, 10, NULL);
+    }
+    fd_Wait (10);
+  }
+}
+</pre>
+}}
+while文で使用していたプッシュボタンの条件を外し、新たにゴールポジション設定後にif文の条件として使用します。
+プッシュボタンが押されたらリセットを行いますので、!(エクスクラメーションマーク)は除きます。
+リセットはアドレス36(音量最大保持値)に0を書込むことで実施します。
+**動作確認 [#i7d7d3c6]
+プログラムが完成しました。プログラムを書き込んで動かしてみましょう。
+FDIII-HCのプッシュボタンを押しリセットしてから、音を出すとAX-12Aが音量に応じて動くことを確認しましょう。
+#ref(SoundMeter_p9.png)
+[[次のチャプターへ>FDIIICHAPTER4.4]]~
+[[FDIII-HC Starter Kit Guide>LEARNINGGUIDE]]へ戻る

« Prev Next »

FDIII-HC Starter Kit Guide/Chapter4.3 のバックアップ一覧
FDIII-HC Starter Kit Guide/Chapter4.3 のバックアップの現在との差分(No. All)
- 1: 2011-07-04 (月) 19:26:46 yoshida
- 2: 2011-07-05 (火) 12:09:51 yoshida
- 3: 2011-07-05 (火) 14:01:53 yoshida
- 4: 2011-07-05 (火) 17:44:55 yoshida
- 5: 2011-07-11 (月) 12:28:48 yoshida
- 6: 2011-07-12 (火) 18:45:40 yoshida

メニュー

トップニュースお知らせ新商品情報更新情報マニュアル類技術情報チュートリアル FAQ お問合せ技術的なお問合せその他お問合せお見積りブログ会社案内

ショッピング

ご利用案内検索カテゴリ一覧ロボットキット Dynamixelシリーズマイコンボード相撲ロボットセンサ通信機器お客様ページ

FDIII-HC Starter Kit Guide​/Chapter4.3 のバックアップの現在との差分(No.3)

FDIII-HC Starter Kit Guide/Chapter4.3 のバックアップの現在との差分(No.3)