convert boxes to pqp model
fix error when null inertia
add function to compute world point in local frame