PiPERのcontroller
状態:開発中
開発中 PiPER,Pika Gripper,Pika Senseのdriverは,どれも実機で動かしていません.ここの構成は,repositoryの模擬の構成 .roboloom/piper-mock/ で確かめたものです.
PiPER 2台とPika Gripper 2台を動かすcontrollerの一覧です.roboloom init のtemplateはまだないので,.roboloom/piper-mock/ を写して使います(PiPER+Pikaを模擬で).
| Controller | 入力 | option | 状態 |
|---|---|---|---|
| Pika SenseとIK | 腕ごとのPika Sense | なし | 開発中 |
| 方策 | 方策 | policy |
開発中 |
- 方策+介入(
teleop:)は使えません.介入に使えるcontrollerはtype: jointだけで,pose_ikは読み込みのときに断ります(teleopと介入). - leader(
joint)で動かす構成はありません.
flowchart LR
T["lighthouse<br/>tracker"] --> S["left_sense / right_sense"]
S --> K["left_ik / right_ik<br/>type: pose_ik"]
P["方策"] --> C["policy<br/>type: policy"]
K --> F["left, right<br/>left_gripper, right_gripper"]
C --> F
Pika SenseとIK
開発中
1つのSenseで,腕1台とgripper 1台を動かします.Senseの姿勢を逆運動学でPiPERの関節角に,挟みの角度をgripperの角度に変えます.
# .roboloom/piper-mock/nodes/left_ik.yaml(抜粋)
type: pose_ik
input: left_sense
followers: [left, left_gripper]
arm: left
gripper: left_gripper
tool_offset: {xyz: [0.0, 0.0, 0.19], rpy: [0.0, -1.5708, 0.0]} # AgileXのgripperの値.Pika Gripperでは測る
workspace: {min: [0.05, -0.45, 0.05], max: [0.6, 0.45, 0.6]} # m
gripper_map: {scale: 1.0, offset: 0.0}
max_speed: {left: 1.0, left_gripper: 3.0}
home: {left: {pose: ../poses/left/ready.yaml, max_speed: 0.5, tolerance: 0.02}}
command_deadline_ms: 100
input_timeout_ms: 150
uv run roboloom run piper-mock
- 腕は折りたたんだ姿勢(すべて0)で始まり,そこではIKが手にほとんど追従できません.先に「Move home」で
poses/<arm>/ready.yamlへ動かします. - 共通の説明:Pika SenseとIK.
方策
開発中
option policy は,SenseとIKのcontrollerを外し,controllers.policy を足します.roboloom infer が自動で有効にします.
# .roboloom/piper-mock/nodes/policy.yaml
type: policy
followers: [left, right, left_gripper, right_gripper]
factory: demo_policy:wave # 同じdirectoryの確認用の方策
observe: [camera, left_wrist, right_wrist]
rate_hz: 10
action_horizon: 2
max_speed: {left: 1.0, right: 1.0, left_gripper: 3.0, right_gripper: 3.0}
command_deadline_ms: 300
uv run roboloom run piper-mock --with policy
uv run roboloom infer piper-mock --seconds 20 \
--policy roboloom.policy.lerobot:load --policy-kwargs '{"path": "<checkpoint>"}'
- 観測と行動は14要素(腕6+6,gripper 1+1)で,単位はradです(観測と行動).
- 推論の構成にはSenseがないので,方策は
observation.left_senseなどを使えません. - 共通の説明:方策(controller),方策を動かす.