jrl-umi3218 / mc_openrtm

Interface between OpenRTM and mc_rtc
BSD 2-Clause "Simplified" License
3 stars 10 forks source link

Read floating base groundtruth #7

Closed arntanguy closed 4 years ago

arntanguy commented 4 years ago

This PR connects the following ports to the "FloatingBase" BodySensor:

This allows reading ground-truth floating base information from choreonoid simulation.

Note if you wish to use this for your own robots:

Everything is set-up for the simulations with the JVRC robot provided with this repository. If you wish to obtain grountruth information for your own robot, you will need the following:

out-port = waistAbsTransform:PELVIS:ABS_TRANSFORM2
out-port = waistAbsVelocity:PELVIS:ABS_VELOCITY
out-port = waistAbsAcceleration:PELVIS:ABS_ACCELERATION
    connectPorts(rh.port("waistAbsTransform"), mc.port("basePoseIn"))
    connectPorts(rh.port("waistAbsVelocity"), mc.port("baseVelIn"))
    connectPorts(rh.port("waistAbsAcceleration"), mc.port("baseAccIn"))