Python makeCommandPoseの例

コード例 #1

ファイル: user.py プロジェクト: s-creek/script

def test():
    pose = [ -30, 0, 0, 0, 0, 0,
              -30, 0, 0, 0, 0, 0,
              0, 0, 0,
              0, 0, 0,
              10, -5, 0, -30, 0, 0, 0,
              0, 0, 0, 0, 0, 0,
              10,  5, 0, -30, 0, 0, 0,
              0, 0, 0, 0, 0, 0 ]
    seq_svc.setJointAngles(bodyinfo.makeCommandPose(pose), 5.0)

コード例 #2

ファイル: user.py プロジェクト: hsnuhayato/tsml

def goHalfSitting():
    tm = bodyinfo.timeToHalfsitPose
    seq_svc.setJointAngles(bodyinfo.makeCommandPose(bodyinfo.halfsitPose), tm)
    #seq_svc.setBasePos(bodyinfo.halfsitBasePos, tm)
    #seq_svc.setZmp([0.023, 0, -bodyinfo.halfsitBasePos[2] ], tm)
    seq_svc.waitInterpolation()

コード例 #3

ファイル: user.py プロジェクト: hsnuhayato/tsml

def goInital():
    tm = bodyinfo.timeToInitialPose
    seq_svc.setJointAngles(bodyinfo.makeCommandPose(bodyinfo.initialPose), tm)
    #seq_svc.setBasePos([0.0, 0.0, bodyinfo.initialWaistHeight], tm)
    #seq_svc.setZmp([0.0, 0.0, -bodyinfo.initialWaistHeight], tm)
    seq_svc.waitInterpolation()

コード例 #4

ファイル: sot_ben.py プロジェクト: benwayne182/hrp2_bike_dynamic

def setJointAnglesDeg(pose, tm, wait=True):
    seq_svc.setJointAngles(bodyinfo.makeCommandPose(pose), tm)
    if wait:
        seq_svc.waitInterpolation()

コード例 #5

ファイル: user.py プロジェクト: s-creek/script

def goHalfSitting():
    tm = bodyinfo.timeToHalfsitPose
    seq_svc.setJointAngles(bodyinfo.makeCommandPose(bodyinfo.halfsitPose), tm)
    seq_svc.setBasePos([0.0274, 0.0, 0.7879], tm)
    seq_svc.setZmp([0.0274, 0.0, -0.7879], tm)
    seq_svc.waitInterpolation()

コード例 #6

ファイル: sot_ben.py プロジェクト: benwayne182/hrp2_bike_dynamic

def setJointAnglesDeg(pose, tm, wait=True):
    seq_svc.setJointAngles(bodyinfo.makeCommandPose(pose), tm)
    if wait:
        seq_svc.waitInterpolation()