Leader
状態:実機検証済み
実機検証済み Rakuda2のleader(通常と重力補償付き)による収集は実機で確かめています.関節の固定(law: position),関節間の相殺(couplings)とその組み合わせは 模擬のみ です.力の逆送は 模擬のみ(中断中)です.
Rakuda2の遠隔操作では,inputs の leader node(機器は type: rakuda_mini,Rakuda-mini)が関節位置を読み,controllers の joint nodeがfollowerの目標へ変換します.leaderはfollowerと同じ関節名と単位を持つので,followerの各関節は同じ名前のleaderの関節に追従します.ほかに書くことはありません.
type: joint
input: leader
followers: [follower]
alignment_tolerance: 300
max_speed: 2048
command_deadline_ms: 100
input_timeout_ms: 150
leader は設定の中での役割の名前で,type は使う機器の名前です.別のarmをleaderに使う場合は,type だけを変えます.
これらは配布templateの値です.機体の可動域・通信周期・停止挙動を確かめた上で設定してください.
| 項目 | 意味 |
|---|---|
alignment_tolerance |
追従を始める前と,毎回のepisode開始(start)の前に許すleaderとfollowerの関節差(counts).超えていると start を拒否します |
joints |
任意.書かなければ,followerの各関節は同じ名前の入力の関節に追従する(入力がfollowerの関節をすべて持つこと).書くときは,followerの関節ごとに {leader, follower, sign, offset} を,followerの順に並べる.名前が違う,向きが逆(sign: -1),ずれがある(目標=leader × sign + offset)場合に使う.減速比や単位がfollowerと違うleader(countで読むGELLO型のleaderと,radの腕など)は,各関節に scale(正の数)を足す:目標=sign × scale × leader + offset.全関節に scale を書けば,入力とfollowerの単位は違ってよい(offset,max_speed,alignment_tolerance はfollowerの単位).力の逆送(feedback)とは併用できない |
unit |
任意.入力とfollowerの単位は同じでなければならない(Rakuda2は dynamixel_count).書いた場合は両方と一致させる |
max_speed |
目標値の変化速度の上限(followerの単位/s.Rakuda2はcounts/s) |
followers |
動かすfollower.joint controllerはちょうど1台です |
command_deadline_ms |
followerへ送る指令の有効期限 |
input_timeout_ms |
leader入力が古いと判定するまでの時間 |
follower_timeout_ms |
followerの状態が古いと判定するまでの時間(既定150).古くなると追従をやめ,位置を合わせ直すまで指令を送りません |
画面で aligning が出たら,表示された関節差を見ながらleaderをfollowerに揃えます.following になってから start <task> します.入力が古いと input_stale となり,新しい入力なしに追従を続けません.
leaderのtriggerは law: spring,重力補償は law: gravity_comp で設定します.これらはleader node自身が実行するmotor制御則です.実機では Session / CLIのdataflowで動かします.InProcessSession.from_yaml() は制御則を実行するleaderを受け付けません.
具体的なsetupは Rakuda2 Quick start にあります.
対応する機体
| 機体 | 入力 | 状態 | 設定例 |
|---|---|---|---|
| Rakuda2 | Rakuda-mini(rakuda_mini) |
実機検証済み | Rakuda2のcontroller |
leaderの関節を固定する
使用する nodes/leader.yaml または nodes/leader_gravity.yaml を土台にしたfile(extends)を作るか,そのfile自体の control で,固定する関節を law: position のgroupへ移します.例えば,templateの body groupを次の2 groupに置き換えると,腰は手で動かせ,首のyawとpitchは固定されます.腕とtriggerのgroupは残してください.既存の設定で胴体・頭部が hand に含まれる場合は,この3関節を hand から取り除きます.全関節がちょうど1 groupに含まれる必要があります.
control:
- group: body
law: free
joints: [torso_yaw]
- group: fixed_head
law: position
joints: [head_yaw, head_pitch]
# 腕とtriggerの既存groupを続けます.
position は通電直前の実測位置を目標として書いてから,選択した関節だけtorqueをオンにします.古いGoal Positionへ移動させる処理ではありません.leaderは外部目標を受けないため,その位置を保持します.固定はSessionの起動時から有効で,stop で収集を止めても続き,estop・release・quit で脱力します.起動前に,固定するleader関節をfollowerの姿勢へ揃えてください.
motorの位置制御と対応bus APIが必要です.Operating Modeは position(Rakuda2では3)を読み返して検査し,不一致では通電しません.変更が必要な場合はdataflowを止め,機体を支持した上で既存の roboloom commission leader を使います(起動optionでleaderを選ぶ場合は --with も指定します).nodes/follower.yaml の torque: false はleaderの固定を無効にしません.
関節間の相殺を設定する
nodes/controller.yaml の couplings は,関節対応・符号・offsetで変換した目標へ,followerの別関節の実測変位を加えます.既定は [](無効)です.Rakuda2の腰yawと首yawで,同じcount変化が同じ向きの回転を表す場合は次の設定になります.
couplings:
- joint: head_yaw
source: torso_yaw
scale: -1.0
reference: 2048
lead_ms: 70
首の目標 = leaderから変換した首の目標
- (followerの現在の腰位置 + 腰の速度 × lead_ms - reference)
reference は,leaderから変換した首の目標をそのまま使う腰の位置(counts)です.腰が正面を向く位置を設定します.例えば腰が reference から+100 counts回転すると,首の目標に-100 countsを加えます.上の関節固定と併用すると,leaderの首を固定したまま腰の回転を相殺できます.leaderの首を自由にすると,操作者による首の操作に相殺分が加わります.
jointとsourceはfollowerの関節名です.同じ関節の指定,未知の関節,重複したjoint,有限値でないscaleは設定読み込み時に拒否します.- 基準は設定した固定値です.位置合わせの時点の姿勢は使いません.位置合わせは許容差(
alignment_tolerance)内のずれを認めるため,その時点の姿勢を基準にすると,ずれの分だけ首が常に偏ります.再位置合わせやleader nodeの再起動でも基準は変わりません. - 位置合わせでは相殺後の首の目標とfollowerの首を比べます.followerのcameraが正面から大きく外れた状態で起動すると,
head_yawが許容差を超えてaligningのままになります.起動前にfollowerのcamera向きとleaderの首を揃えてください. - 腰の目標値ではなく実測値を使うため,腰が指令に追いついていない段階で首だけを先回りさせません.相殺後にも既存の速度制限とfollower側の範囲・期限・変化量検査がかかります.
joint・source・scale・referenceはすべて必須です.lead_ms(任意,既定0,0〜500)は,腰の実測速度の方向へ目標を先読みする時間です.首のmotorは位置制御で目標に遅れて追従するため,腰が動いている間はcameraが遅れてずれます.Rakuda2では,腰を最大69°/sで回したときのずれ(最大4.6°)が,腰の速度×約70 msでほぼ説明できました(相関0.99,2026-10-27の記録).このため例では70としています.大きすぎると首が行き過ぎます.robotが速度を出さない場合,先読みは加えません.- これは指定した関節間の線形な相殺です.全姿勢のcamera安定化,IMU feedback,台座の回転補償ではありません.軸が平行で,符号と単位比が正しいことが前提です.他の機体では
scaleに軸の符号と単位比を設定します.速度制限や可動域端,追従遅れではcameraの向きに誤差が残ります. type: jointの遠隔操作に適用します.方策controllerの出力には適用しません.関節名をcodeに固定していないので,他のrobotのjoint controllerにも使えます.
関節固定と相殺の組み合わせは模擬bus・controllerで検証しています.実機での方向・可動域・追従精度は未検証です.既存の .roboloom/ は自動更新しないため,設定例を使用中のYAMLへ反映してください.
初期姿勢へ動かす(home)
保存した初期姿勢へ,leaderとfollowerを home の操作でゆっくり動かせます.episodeを毎回同じ姿勢から始めるためのものです.着いてから1秒後,leaderは通常の制御(重力補償とbreakaway hold)に戻るので,そのまま手で持って操作を始められます.
1. 姿勢を保存します. followerを使いたい姿勢にしてから,dataflowを止めた状態で実行します.名前ごとに poses/<follower>/<name>.yaml が作られ,いくつでも保存できます.同じ名前は --force なしでは上書きしません.fileには保存したfollowerの名前が入り,別のfollowerでは読み込めません(左腕の姿勢を右腕で使う事故を防ぐため).followerが複数ある設定では,capture-pose left ready のようにfollowerを指定します.
uv run roboloom capture-pose ready
followerを姿勢にするには,遠隔操作で動かしてから quit で hold(followerを保持したまま終了)とするか,release 後に手で動かします.capture-pose はfollowerの位置を読むだけで,動かしません.busを開くときの通常の起動時の検査は行います.
2. controllerのYAMLで使う姿勢を選びます.
home:
pose: ../poses/follower/ready.yaml # 保存した姿勢のどれか
max_speed: 200 # counts/s(約18°/s).遅く動かすための上限
tolerance: 30 # 各関節がこの差以内なら到着(必須.followerの単位)
timeout_s: 30
重力補償leaderの電流制御のgroupには,姿勢へ引くばねの設定が必要です.なければ設定の読み込み時に拒否します.
- group: right_arm
law: gravity_comp
# ...
homing:
kp_mA_per_count: 0.5 # 目標との差1 countあたりの電流
max_mA: 40 # ばねの電流の上限.重力補償との合計は max_current_mA で制限
3. 動かします. 操作画面で home と入力します(roboloom session home,Pythonでは Session.home() も同じ).controllerの行に home pose: ready.yaml と,使う姿勢の名前が表示されます.移動中はrobotとleaderの行に進み具合が出て,到着すると reached になります.
- 全関節が同じ時間で到着するよう,滑らかな速度の曲線で動かします.最も遠い関節でも速さは
max_speedを超えません. - followerは,通常の指令と同じ範囲と速度の検査を通して動きます.
stop・estopで移動を止められます. - leaderの動かし方は関節の制御則で変わります.
- 電流制御(
gravity_comp):重力補償に,homingのばね(上限つき)を足して引きます. - 位置制御(固定した首など):目標を姿勢に沿って動かします.移動後は固定の目標がその姿勢になります.
free:motorが位置制御のmodeのときだけ,移動中にtorqueを入れて動かし,到着後に脱力へ戻します.それ以外は動かさず,画面に表示します.- triggerのばね:動かしません.
- 電流制御の関節は,静止摩擦のためにばねが姿勢の手前で止まることがあります.許容差(
tolerance)より離れた関節は,到着後にshort(黄)として差(counts)を表示します.開始できるかは,通常の位置合わせの検査(alignment_tolerance)で決まります.差が大きい場合はkp_mA_per_countかmax_mAを上げます. - followerは,移動が終わったあと,測った関節がすべて
tolerance以内に入るとreachedになります.入るまではsettlingです.2秒たっても入らない関節があればshort(赤)として関節名と差を表示し,Session.home()(record --homeを含む)は失敗し,startも拒否します.重さで垂れる関節は,支えるかtoleranceを見直してから,もう一度homeを実行します. - leaderの目標は,controllerの関節対応(符号・offset)と
couplingsを逆にたどって計算します.到着後のleaderとfollowerの差はほぼ0です. - 録画中や追従中(
start後)はhomeを拒否し,移動中はstartを拒否します. - 移動中は腕から手を離してください.
estop・release・quitでは今までどおりleaderが脱力します.
模擬のbusとdataflowで動作を確かめています.実機での動きは未検証です.
力の逆送を受ける(実機未検証)
電流制御のgroup(gravity_comp,impedance)に feedback: を書くと,そのgroupの関節は,controllerが返すfollowerの外力を電流として受け取ります.実機では確かめていません.
- group: right_arm
law: gravity_comp
# ... 既存の gravity_model, tuning, range など
feedback:
max_mA: 20
ramp_s: 0.3
kd: 0.0
どの関節に返すかは,controllerの feedback.gain で選びます.逆送は重力補償などの出力に足してから max_current_mA で制限し,gateは ramp_s かけて開閉します.estop・release・quitでは即座に0になります.keyの意味と安全の仕組みは 設定 の「力の逆送」,Rakuda2での組み合わせは Rakuda2 の「bilateral」を参照してください.