more efficient cvx hull, correct rviz display