More improvements to Spline3. Still need to fix FrenetFrame segment count