transform footstep relative to hrpsys coordinate system