update body's worldcoords before using its faces
Merge pull request #185 from YoheiKakiuchi/fix_visualizaion

update body's worldcoords before using its faces