leader の重力補償の調整
leader の腕を,手を離してもその場に留まり,ある程度の力で押したときだけ動くようにします.
ここでは,補償の電流の決まり方,gain と hold_mA の意味,それに roboloom tune-gravity で関節ごとに手で調整する手順を説明します.
1.送る電流の式
制御の周期ごと(leader の poll_hz,templateでは120 Hz)に,関節ごとの電流を次の式で決めます.
送る電流 = 上限で切る( ramp × ( gain × g(q) + 保持 − kd × 速度 ) + 可動域の押し戻し ) [mA]
| 項 | 意味 | どこで決まるか |
|---|---|---|
| g(q) | 姿勢 q で関節を保つのに要る電流を,重力modelが予測した値 | identify-gravity で同定(calibration/gravity_<side>.yaml) |
| gain | g(q) に掛ける倍率 | tune-gravity(calibration/gravity_tuning_<side>.yaml) |
| 保持 | 置いた位置に引き留める電流.最大 ±hold_mA |
同上 |
| kd | 速度に比例するbrake(今は 0) | nodes/leader_gravity.yaml |
| ramp | 起動直後の ramp_s 秒で,0 から 1 に上がる |
同上 |
| 押し戻し | 可動域の外に出たときだけ,外に出た量に比例してかかる | calibration/travel_<side>.yaml と barrier_mA_per_count |
| 上限 | max_current_mA.EEPROM の Current Limit でもmotor側で同じ値に切られる |
nodes/leader_gravity.yaml |
motorの力(torque)は,電流にほぼ比例します.XC330 の電流の単位は 1 mA です.
2.gain:重さをどれだけ消すか
g(q) はあくまで予測です.効き方を決めるのは「送った電流 ÷ 実際に必要な電流」の比で,補償の割合はおおよそ次のとおりです.
補償の割合 ≈ gain × g(q) ÷ 実際に必要な電流
予測が正しければ,gain 1.0 で補償の割合は 100% になります. 研究室の機体では,位置制御で測った保持電流が,gearの静止摩擦のために実際より小さく出ました.そのため,g(q) は必要な電流の約半分になりました.
| 例:右肩 sh_roll,腕を横に水平 | 値 |
|---|---|
| g(q) | 約 58 mA |
| gain 1.0(58 mA を送る) | 手を離すと,補償なしと同じように落ちた |
| gain 2.0(114 mA を送る) | 留まった(わずかに上がった) |
| 実際に必要な電流(推定) | 約 100 mA.gain 1.8 で約 100% |
| 補償の割合 | 手を離したときの関節 |
|---|---|
| 0% | 補償なし.torqueを切ったときと同じように落ちる |
| 50% 程度 | 重さは半分になるが,落ちる |
| 約 100% | 重さが消える.gearの摩擦で,その場に留まる |
| 100% を大きく超える | ゆっくり上がっていく |
| マイナス(向きが逆) | 落ちるのを速める |
摩擦があるので,100% ちょうどでなくても留まる幅があります.
3.hold_mA:どれくらいの力で押したら動き出すか
「押し負けたら動く保持」です.摩擦をソフトで足すものと考えてください.
- 関節を,今いる位置にばね(
hold_kpmA/count,既定 1.0)で引き留めます.引き留める力はhold_mAを超えません. - それより強く押すと,引き留める位置が手の動きについていきます.手を離すと,そこで止まります.
- 重力modelの誤差が
hold_mA以内なら,どの姿勢でも関節は留まります. - 代わりに,動かし始めるときに,
hold_mA分だけ余計に力が要ります. - 例:
hold_mA: 30,hold_kp: 1.0なら,30 count(約 2.6°)押し込むまでは戻ろうとし,それを超えると滑ります.
gain は「重さをどれだけ消すか」,hold_mA は「どれくらいの力で押したら動き出すか」を決めます.この 2 つは別々に調整します.
4.感触ごとの調整
| 感触 | 原因 | 調整(tune-gravity のkey) |
|---|---|---|
| 置いても,ゆっくり下がる | 補償が足りない(誤差が保持を超えている) | gain を上げる(],+0.1) |
| 置くと,ゆっくり上がる | 補償しすぎ | gain を下げる([,−0.1) |
| 動かし始めが重い,引っかかる | 保持が強すぎる | hold_mA を下げる(-,−5 mA) |
| 姿勢によって下がったり上がったりする | 姿勢ごとの予測の誤差 | hold_mA を上げる(=,+5 mA).根本的には,電流制御で測り直す |
5.tune-gravity の手順
前提:
- identify-gravity,measure-travel,commission が済んでいること(.roboloom/<robot>/README.md の手順 3〜6).
- dataflow を止めておくこと.
uv run roboloom tune-gravity leader right_arm --with gravity
- 腕を支えたまま起動します.電流は
ramp_s秒かけて上がります.ほかの電流制御groupは重力gainとbreakaway holdをゼロにしますが,torque offではなく,可動域の押し戻しや減衰は残ります.位置制御groupは目標を保持する場合があります.調整終了時は全groupを明示的に脱力してからbusを閉じます. - Textualの一覧で関節を選び,Detailsで値の意味,調整の説明,選んだ関節の次の値を確認します.
- ID,gain,hold,g(q),送った電流,実際の電流,位置,速度
- 状態:
gravity(重力補償だけ),holding(保持が効いている),sliding(押し負けて滑っている),free(何もしない),off(比較のため重力補償を切っている) - 「guide」の欄に,選んだ関節で重力がかかる姿勢が出ます.その姿勢に置いて手を離し,その関節がどう動くかを見ます.
- 4 節の表に従って,keyで gain と hold を変えます.値はすぐに反映されます.
0を押すと,その関節の重力補償だけを切って,補償なしの感触と比べられます.もう一度押すと戻ります.- Ctrl-Nで関節一覧へ移り,↓で次の関節を選びます(Ctrl-Lの入力欄で
joint <name>も使えます).gain 0で重力の影響が小さい関節(ねじりの関節など)は,そのままにして次へ進みます. - menuまたは
saveで保存します(calibration/gravity_tuning_right.yaml).quitまたはCtrl-Qで終了し,保存・破棄・cancel(初期選択)を選びます.保存中の追加変更は未保存として残ります. - 左腕も
left_armで同じように調整します.
調整した値は,option gravity を有効にした起動(roboloom run --with gravity,またはlauncherで gravity を選ぶ)でそのまま使われます.
6.安全のための仕組み
- EEPROM の Current Limit: PC が止まっても効く,唯一の守りです.
- XC330 では,Bus Watchdog が作動しても電流は止まらず,そのときの電流で固まります(2026-10-23 に試験).
- そのため,上限は必要な分のすぐ上に設定します.例:肩 150 mA,肘 100 mA,手首 60 mA.
- gain を上げて上限に張り付く場合は,
max_current_mAと EEPROM の両方を見直し,もう一度commissionを実行します. - 暴走検知:
- 次の場合は,腕が脱力し,画面に
STOPPEDと出ます.- 可動域+
range_marginの外に出た. - 電流をかけている関節が
max_velocityを超えて動いた.
- 可動域+
- 腕を支えてから
rで再開します. - Watchdog: 制御が
bus_watchdog_ms(500 ms)以上止まると Watchdog が作動します.書き込みが途切れたときと100 msごとにこれを確かめ,作動していたら腕を脱力させます.100 ms では,たまに起きる 130 ms 程度の遅れで作動してしまいました.
7.同定の限界と,根本的な直し方
- g(q) の大きさが半分程度に出たのは,位置制御で保持電流を測ったためです.
- 静止摩擦があると,腕は摩擦の幅の中のどこでも止まれます.
- そのため,上から近づけた場合と下から近づけた場合の 2 回の平均が,重力を表しません.
- 電流制御で測れば,この影響を受けません.電流を少しずつ上げて動き出す値と,下げて落ち始める値を求め,その中間をとります.
- 測り直すまでは,gain で量を補正し,hold で姿勢ごとの誤差を吸収します.
- 体感を数値で確かめたいときは,
gravity-checkが使えます.同じ姿勢で,gain の倍率を変えて手を離し,各関節が動いた量を比べます.
uv run roboloom gravity-check leader right_arm --poses 1 --scales 1,0,2,-2 --with gravity
menuと編集可能な入力欄は joint <name>・gain + / -・hold + / -・compare・resume・save・estop・quit を共用します.Ctrl-Gは次の制御処理で脱力して再起動までESTOPをlatchします.resume は通常のSTOPPEDだけを再開します.制御とfile保存は描画から独立し,非TTYは機器open前に拒否します.focus・入力・確認のkeyは 操作画面 を参照してください.