Fix 3D length shorter than 2D length (fixes #1337)

Add all original points in addition to points sampling when draping