Added a range-only 3d estimation problem