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

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

--- 13: 2011-08-02 (火) 20:33:08 yoshida
+++ 現: 2013-08-07 (水) 20:22:54 yoshida
@@ Line 3: / Line 3: @@
 **Dynamixel Configuratorで動かす [#i7e648cf]
-まずは確認のため、[[Dynamixel Configurator>BTE068]]でAX-12+を作動させてみましょう。トルク設定をしていませんので、ポジション移動の際は十二分に注意して下さい。~
+まずは確認のため、[[Dynamixel Configurator>BTE068#e84cbf19]]でAX-12+を作動させてみましょう。トルク設定をしていませんので、ポジション移動の際は十二分に注意して下さい。~
 ID1からID6まで以下の手順を繰り返します。
 +「Read All」で状態を読み込む。
@@ Line 10: / Line 10: @@
 **物を掴む [#a91d93dc]
 ID1~ID3でハンド部分の位置が決まり、ID5、6でハンド部分が開閉します。~
-空のペットボトル等を掴んで持ち上げてみましょう。
+空のペットボトル等を掴んで持ち上げてみましょう。~
-#ref(Clip.png)
+#ref(DXCONF.png)
 如何でしょうか。持ち上げることができたでしょうか。~
 Dynamixel Configuratorでは、個々のアクチュエータにそれぞれ手動で指令を行わなければならず、随分と手間がかかるのではないでしょうか。~
@@ Line 34: / Line 34: @@
   fd_DXSetPosition (4, 512);
   fd_DXSetPosition (5, 512);
+  fd_DXSetPosition (6, 512);
   fd_Wait (1000);
@@ Line 44: / Line 45: @@
   fd_Wait (1000);
   // 腕を下げる
-  fd_DXSetPosition (2, 818);
+  fd_DXSetPosition (2, 700);
+  fd_DXSetPosition (3, 400);
   fd_Wait (1000);
   // 挟む
@@ Line 52: / Line 54: @@
   // 持ち上げる
   fd_DXSetPosition (2, 512);
+  fd_DXSetPosition (3, 512);
   fd_Wait (1000);
   // 右へ移動
@@ Line 57: / Line 60: @@
   fd_Wait (1000);
   // 腕を下げる
-  fd_DXSetPosition (2, 818);
+  fd_DXSetPosition (2, 700);
+  fd_DXSetPosition (3, 400);
   fd_Wait (1000);
   // 離す
@@ Line 69: / Line 73: @@
   fd_DXSetPosition (4, 512);
   fd_DXSetPosition (5, 512);
+  fd_DXSetPosition (6, 512);
   fd_Wait (1000);
 }
@@ Line 74: / Line 79: @@
 }}
 今回はDynamixel Configuratorでの操作をそのままプログラムしました。指定位置は掴むものに合った値に変更して下さい。~
-まだ動きが随分とぎこちないですね。もう少し滑らかに動くように修正します。
+いきなり動き出したり、このプログラムでは動きが随分とぎこちないですね。もう少し滑らかに動くように修正します。
 **モーション [#q1da695a]
@@ Line 85: / Line 90: @@
 ****初期化 [#w63f4eb4]
+初期化には次の様にAPIを使用します。
 #html{{
 <pre class="brush:c;toolbar:false">
@@ Line 90: / Line 96: @@
 </pre>
 }}
 *****[[fd_SetSpec>FDIIILIB#r0f0534c]] [#a6a7bd34]
 指定された値を使用して、初期設定を行います。~
-''第1引数''は、ホームポジションを指定したTHomePosition構造体変数のアドレスです。~
+''第1引数''は、ホームポジションを指定した[[THomePosition構造体>FDIIILIB#fa1e627a]]変数のアドレスです。~
-''第2引数''は、アクチュエータの情報を指定したTSpec構造体変数のアドレスです。~
+''第2引数''は、アクチュエータの情報を指定した[[TSpec構造体>FDIIILIB#w18bc93a]]変数のアドレスです。~
 ''第3引数''は、TSpec配列数です。
-*****THomePosition構造体 [#e87812da]
+*****[[THomePosition構造体>FDIIILIB#fa1e627a]] [#e87812da]
 基準となる位置を指定します。
 #html{{
@@ Line 105: / Line 112: @@
 軸のアクチュエータに対し、512(出力軸は150°)を指定しています。
-*****TSpec構造体 [#lbf8e4eb]
+*****[[TSpec構造体>FDIIILIB#w18bc93a]] [#lbf8e4eb]
 各初期情報を指定します。
 #html{{
 <pre class="brush:c;toolbar:false">
 const TSpec Spec[] = {
-  { 1, DEV_AX12, fd_AxisOfs(0), +341, {  257,  768},   0, 1023, { 1, 1, 32,  32} },
+  { 1, DEV_AX12, fd_AxisOfs(0),  +341, {  257,  768},   0, 1023, { 1, 1, 32,  32} },
-  { 2, DEV_AX12, fd_AxisOfs(1), +341, {  390,  818},   0, 1023, { 1, 1, 32,  32} },
+  { 2, DEV_AX12, fd_AxisOfs(1),  +341, {  390,  818},   0, 1023, { 1, 1, 32,  32} },
-  { 3, DEV_AX12, fd_AxisOfs(2), +341, {   64,  512},   0, 1023, { 1, 1, 32,  32} },
+  { 3, DEV_AX12, fd_AxisOfs(2),  +341, {   64,  512},   0, 1023, { 1, 1, 32,  32} },
   { 4, DEV_AX12, fd_AxisOfs(10), +341, {    0, 1023},   0, 1023, { 1, 1, 32,  32} },
   { 5, DEV_AX12, fd_AxisOfs(11), +341, {    0,  592},   0, 1023, { 1, 1, 32,  32} },
@@ Line 119: / Line 126: @@
 </pre>
 }}
-AX-12+のIDを1~6と設定しているので、それらをオフセット0~2と10~12へ割り当てます。オフセットは60の配列の為、59まで使用可能となっており、TApplyPartで指定するオフセットと対応していればどのような順番であっても問題ありません。
+AX-12+のIDを1~6と設定しているので、それらをオフセット0~2と10~12へ割り当てます。オフセットは60の配列の為、59まで使用可能となっており、[[TApplyPart>FDIIILIB#q3b8aabf]]で指定するオフセットと対応していればどのような順番であっても問題ありません。
 ****モーション再生 [#u5c51edb]
+モーションを再生するには次の様にAPIを使用します。
 #html{{
 <pre class="brush:c;toolbar:false">
+fd_PlayMotion (GoToHomePosition, 1, sizeof(GoToHomePosition)/sizeof(TPose), 100, &HandParts);
 </pre>
 }}
 *****[[fd_PlayMotion>FDIIILIB#xc988ccc]] [#h4574808]
+指定されたモーションを指定部位にて再生します。~
+''第1引数''は、モーションデータを指定した[[TPose構造体>FDIIILIB#y2b4d82e]]変数のアドレスです。~
+''第2引数''は、モーションの開始位置を指定します。~
+''第3引数''は、モーションの終了位置を指定します。~
+''第4引数''は、モーションの再生スピード(%)を指定します。~
+''第5引数''は、モーションを再生部位を指定した[[TApplyPart構造体>FDIIILIB#q3b8aabf]]変数のアドレスです。~
+*****[[TPose構造体>FDIIILIB#y2b4d82e]] [#ra67c632]
+ホームポジションからの角度情報を指定します。ポーズが1つでも、配列として宣言します。
+#html{{
+<pre class="brush:c;toolbar:false">
+const TPose GoToHomePosition [] = {
+  { Structure:{ 0, 0, 0, 0, 0, 0 },  Adj:ADJ_SACC_SDECEL, Div:2000, },
+};
+</pre>
+}}
+上記は6軸全てを0°としており、全てのAX-12+をホームポジション位置へ移動させます。~
-*****TApplyPart構造体 [#fdec1af9]
+*****[[TApplyPart構造体>FDIIILIB#q3b8aabf]] [#fdec1af9]
-モーションはTApplyPartで設定された部位単位に動きます。1つのアクチュエータを複数の部位で使用しても問題ありません。~
+アクチュエータを取りまとめた部位の設定を行います。~
-但し、その場合はPriorityが有効になります。
+アクチュエータの指定はIDではなく、[[TSpec>FDIIILIB#w18bc93a]]で宣言したオフセット値を使用します。~
+又、1つのアクチュエータを複数の部位で使用しても問題ありませんが、その場合はPriorityが有効になります。
 #html{{
 <pre class="brush:c;toolbar:false">
@@ Line 153: / Line 180: @@
 Priorityは小さい方が優先となりますので、AllPart>HandPart>ArmPartの順になります。
 #ref(motion2_1.png)
-HandPartを使用したモーションが稼働中にAllPartを使用したモーションを稼働させると、HandPartを使用したモーションは無効となりAllPartを使用したモーションのみが稼働します。~
+ArmPartを使用したモーションを再生するとID1~3が稼働します。
-AllPartとHandPartのPriorityを逆転させてみましょう。
 #ref(motion2_2.png)
-AllPartのモーション稼働時にHandPartのモーションが稼働すると、ID1~3はAllPartのモーションがそのまま稼働し、ID4~6はHandPartのモーションが稼働します。
+ArmPartのモーション再生中にAllPartを使用したモーションを再生すると、ArmPartを使用したモーションは無効となりAllPartを使用したモーションで置き換わります。~
+#ref(motion2_3.png)
-*****TPose構造体 [#if4363ee]
+それではAllPartとHandPartのPriorityを逆転させてみましょう。
-モーションデータになります。部位と合わせて使用します。
+#ref(motion3_1.png)
-#html{{
+AllPartのモーションを再生するとID1~6が稼働します。
-<pre class="brush:c;toolbar:false">
+#ref(motion3_2.png)
-const TPose HomePos[] = {
+AllPartのモーション再生中にArmPartを使用したモーションを再生すると、ID1~3までがArmPartを使用したモーションで置き換わります。ID4~6はHandPartのモーションが稼働します。
-  { Structure:{ 0, 0, 0, 0, 0, 0 },  Adj:ADJ_SACC_SDECEL, Div:1000, },
+#ref(motion3_3.png)
-};
-</pre>
-}}
-モーションデータは配列で宣言して下さい。又、TSpecで宣言したアクチュエータ分、作成して下さい。
 ***モーションプログラム [#s04f1e9e]
-物を掴んで移動する一連の動作をプログラムにします。
+それでは物を掴んで移動する一連の動作をプログラムにします。
 #html{{
-<pre class="brush:c">
+<pre class="brush:c;toolbar:false">
 #include <fd.h>
 #define fd_SetSpec(a,b,c)                   fd_SetSpec((PHomePosition)a,(PSpec)b,c)
@@ Line 180: / Line 202: @@
 const TSpec Spec[] = {
   { 1, DEV_AX12, fd_AxisOfs(0), +341, {  257,  768},   0, 1023, { 1, 1, 32,  32} },
-  { 2, DEV_AX12, fd_AxisOfs(1), +341, {  390,  818},   0, 1023, { 1, 1, 32,  32} },
+  { 2, DEV_AX12, fd_AxisOfs(1), +341, {  300,  818},   0, 1023, { 1, 1, 32,  32} },
-  { 3, DEV_AX12, fd_AxisOfs(2), +331, {   64,  512},   0, 1023, { 1, 1, 32,  32} },
+  { 3, DEV_AX12, fd_AxisOfs(2), +341, {  180,  800},   0, 1023, { 1, 1, 32,  32} },
-  { 4, DEV_AX12, fd_AxisOfs(3), +331, {    0, 1023},   0, 1023, { 1, 1, 32,  32} },
+  { 4, DEV_AX12, fd_AxisOfs(3), +341, {    0, 1023},   0, 1023, { 1, 1, 32,  32} },
-  { 5, DEV_AX12, fd_AxisOfs(4), +331, {    0,  592},   0, 1023, { 1, 1, 32,  32} },
+  { 5, DEV_AX12, fd_AxisOfs(4), +341, {    0,  592},   0, 1023, { 1, 1, 32,  32} },
-  { 6, DEV_AX12, fd_AxisOfs(5), +331, {  432, 1023},   0, 1023, { 1, 1, 32,  32} },
+  { 6, DEV_AX12, fd_AxisOfs(5), +341, {  432, 1023},   0, 1023, { 1, 1, 32,  32} },
 };
 TApplyPart HandParts = {  // 全軸ロボットハンド
@@ Line 236: / Line 258: @@
 }}
-***解説 [#j28efc99]
+少しは滑らかに動くようになったのではないでしょうか。~
-少しは滑らかに動いたのではないでしょうか。では、モーションの使用について説明します。
+最後に逆運動学で各アクチュエータの角度を算出してみます。~
+[[次のチャプターへ>FDIIICHAPTER10.4]]
+[[FDIII-HC Starter Kit Guide>LEARNINGGUIDE]]へ戻る

« Prev Next »

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

メニュー

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

ショッピング

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

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

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