初期位置の確認コマンドで左側リーダー、フォロワーにだけにトルク制御がかかる

[kumazawamt]

python init.py

を実行すると、初期位置に移動するのが、左側のリーダー、フォロワー。
リーダーも移動して、トルク制御がかかっているようで、固くなっている。

実装を見ると、初期化対象はFOLLOWER1,LEADER1だが、FOLLOWER0,FOLLOWER1をトルクモードにするのが正しいのでは？
もしくは、0,1両方を初期化する

# Create controller instances
controller_follower = DynamixelController(constants.FOLLOWER1, baudrate)
controller_leader = DynamixelController(constants.LEADER1, baudrate)

[kumazawamt]

電源ONしたのち、python init.pyを実行せず、teleop.pyのみ実行すると問題なく動作した。