fix wrong inertia coordinates, added the patch from https://code.ros.org/trac/ros-pkg/ticket/5609