Sub-meter Accuracy 3D Indoor Positioning Algorithm by Matching Feature Points of 2D Smartphone Photo