Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

[question] What is setWrenches' argument? #1131

Closed
130s opened this issue May 4, 2017 · 2 comments
Closed

[question] What is setWrenches' argument? #1131

130s opened this issue May 4, 2017 · 2 comments

Comments

@130s
Copy link
Contributor

130s commented May 4, 2017

#434 をみると setWrenches 第一引数の配列の要素は 24 個あります.ac34b71 で PR 出してますが最後の6つは ref_{force, moment} だとすると,最初の18個は何でしょうか?

hcf.seq_svc.setWrenches([0,0,0,0,0,0,
                         0,0,0,0,0,0,
                         0,0,0,0,0,0,
                         10,10,-10,0,0,0,], 2.0);

sample robot は関節が29あるようで,arm だけだとしても14なので,18という数字が判りません.

term-1$ rtmlaunch hrpsys_ros_bridge samplerobot.launch

term-2$ rostopic echo /joint_states/name -n 1
['RLEG_HIP_R', 'RLEG_HIP_P', 'RLEG_HIP_Y', 'RLEG_KNEE', 'RLEG_ANKLE_P', 'RLEG_ANKLE_R', 'RARM_SHOULDER_P', 'RARM_SHOULDER_R', 'RARM_SHOULDER_Y', 'RARM_ELBOW', 'RARM_WRIST_Y', 'RARM_WRIST_P', 'RARM_WRIST_R', 'LLEG_HIP_R', 'LLEG_HIP_P', 'LLEG_HIP_Y', 'LLEG_KNEE', 'LLEG_ANKLE_P', 'LLEG_ANKLE_R', 'LARM_SHOULDER_P', 'LARM_SHOULDER_R', 'LARM_SHOULDER_Y', 'LARM_ELBOW', 'LARM_WRIST_Y', 'LARM_WRIST_P', 'LARM_WRIST_R', 'WAIST_P', 'WAIST_R', 'CHEST']
$ a=('RLEG_HIP_R', 'RLEG_HIP_P', 'RLEG_HIP_Y', 'RLEG_KNEE', 'RLEG_ANKLE_P', 'RLEG_ANKLE_R', 'RARM_SHOULDER_P', 'RARM_SHOULDER_R', 'RARM_SHOULDER_Y', 'RARM_ELBOW', 'RARM_WRIST_Y', 'RARM_WRIST_P', 'RARM_WRIST_R', 'LLEG_HIP_R', 'LLEG_HIP_P', 'LLEG_HIP_Y', 'LLEG_KNEE', 'LLEG_ANKLE_P', 'LLEG_ANKLE_R', 'LARM_SHOULDER_P', 'LARM_SHOULDER_R', 'LARM_SHOULDER_Y', 'LARM_ELBOW', 'LARM_WRIST_Y', 'LARM_WRIST_P', 'LARM_WRIST_R', 'WAIST_P', 'WAIST_R', 'CHEST')
$ echo ${#a[*]}
29
@snozawa
Copy link
Contributor

snozawa commented May 9, 2017

これは、6 x センサの数になってます。
SampleRobotの場合は、4つ手足に力センサがVRMLで定義されてるので、6x4=24になっています。
また、センサの順番はVRMLのsensorIdできまります。
この例の場合は、最後の6個の要素はrhsensor(右手)に相当します。
(細かいですが、ホントはヒューマノイドロボットのこの状況の場合足先にも体重分の力がかかるので、バランス的には足先にもref forceが設定してあるのが正しいですが、腕にimpedanceを入れるというサンプルなので今はこうしています)

wrenchの説明は
http://fkanehiro.github.io/hrpsys-base/dd/d91/SequencePlayer.html
のloadPatternのところにもありますが、idlにも書いておいた方がわかりやすかったですね。

130s added a commit to 130s/hrpsys-base that referenced this issue May 9, 2017
Similar info should be added to IDL level (this Python file is only the end-user API so the number of audience can be minimum).
@130s
Copy link
Contributor Author

130s commented May 9, 2017

@snozawa ありがとうございます.だいぶ頓珍漢な質問をしていたことが判りました...

#1120 で Python I/F に本件の説明を足しました
(Hiro-NEXTAGE ユーザはほとんど/ほぼすべて Python 経由で hrpsys 使うのでそうさせて頂きました).

@130s 130s closed this as completed May 9, 2017
130s added a commit to 130s/hrpsys-base that referenced this issue May 10, 2017
Similar info should be added to IDL level (this Python file is only the end-user API so the number of audience can be minimum).
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

No branches or pull requests

2 participants