[refactoring] use Vec3 instead of Matrix to simplify bvh's joint offset