|
@@ -12,25 +12,20 @@ import { Curve } from '../core/Curve';
|
|
* curve.tension is used for catmullrom which defaults to 0.5
|
|
* curve.tension is used for catmullrom which defaults to 0.5
|
|
*/
|
|
*/
|
|
|
|
|
|
-var CatmullRomCurve3 = ( function() {
|
|
|
|
|
|
|
|
- var
|
|
|
|
- tmp = new Vector3(),
|
|
|
|
- px = new CubicPoly(),
|
|
|
|
- py = new CubicPoly(),
|
|
|
|
- pz = new CubicPoly();
|
|
|
|
|
|
+/*
|
|
|
|
+Based on an optimized c++ solution in
|
|
|
|
+ - http://stackoverflow.com/questions/9489736/catmull-rom-curve-with-no-cusps-and-no-self-intersections/
|
|
|
|
+ - http://ideone.com/NoEbVM
|
|
|
|
|
|
- /*
|
|
|
|
- Based on an optimized c++ solution in
|
|
|
|
- - http://stackoverflow.com/questions/9489736/catmull-rom-curve-with-no-cusps-and-no-self-intersections/
|
|
|
|
- - http://ideone.com/NoEbVM
|
|
|
|
|
|
+This CubicPoly class could be used for reusing some variables and calculations,
|
|
|
|
+but for three.js curve use, it could be possible inlined and flatten into a single function call
|
|
|
|
+which can be placed in CurveUtils.
|
|
|
|
+*/
|
|
|
|
|
|
- This CubicPoly class could be used for reusing some variables and calculations,
|
|
|
|
- but for three.js curve use, it could be possible inlined and flatten into a single function call
|
|
|
|
- which can be placed in CurveUtils.
|
|
|
|
- */
|
|
|
|
|
|
+function CubicPoly() {
|
|
|
|
|
|
- function CubicPoly() {}
|
|
|
|
|
|
+ var c0 = 0, c1 = 0, c2 = 0, c3 = 0;
|
|
|
|
|
|
/*
|
|
/*
|
|
* Compute coefficients for a cubic polynomial
|
|
* Compute coefficients for a cubic polynomial
|
|
@@ -40,147 +35,144 @@ var CatmullRomCurve3 = ( function() {
|
|
* and
|
|
* and
|
|
* p'(0) = t0, p'(1) = t1.
|
|
* p'(0) = t0, p'(1) = t1.
|
|
*/
|
|
*/
|
|
- CubicPoly.prototype.init = function( x0, x1, t0, t1 ) {
|
|
|
|
|
|
+ function init( x0, x1, t0, t1 ) {
|
|
|
|
|
|
- this.c0 = x0;
|
|
|
|
- this.c1 = t0;
|
|
|
|
- this.c2 = - 3 * x0 + 3 * x1 - 2 * t0 - t1;
|
|
|
|
- this.c3 = 2 * x0 - 2 * x1 + t0 + t1;
|
|
|
|
|
|
+ c0 = x0;
|
|
|
|
+ c1 = t0;
|
|
|
|
+ c2 = - 3 * x0 + 3 * x1 - 2 * t0 - t1;
|
|
|
|
+ c3 = 2 * x0 - 2 * x1 + t0 + t1;
|
|
|
|
|
|
- };
|
|
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return {
|
|
|
|
|
|
- CubicPoly.prototype.initNonuniformCatmullRom = function( x0, x1, x2, x3, dt0, dt1, dt2 ) {
|
|
|
|
|
|
+ initCatmullRom: function ( x0, x1, x2, x3, tension ) {
|
|
|
|
|
|
- // compute tangents when parameterized in [t1,t2]
|
|
|
|
- var t1 = ( x1 - x0 ) / dt0 - ( x2 - x0 ) / ( dt0 + dt1 ) + ( x2 - x1 ) / dt1;
|
|
|
|
- var t2 = ( x2 - x1 ) / dt1 - ( x3 - x1 ) / ( dt1 + dt2 ) + ( x3 - x2 ) / dt2;
|
|
|
|
|
|
+ init( x1, x2, tension * ( x2 - x0 ), tension * ( x3 - x1 ) );
|
|
|
|
|
|
- // rescale tangents for parametrization in [0,1]
|
|
|
|
- t1 *= dt1;
|
|
|
|
- t2 *= dt1;
|
|
|
|
|
|
+ },
|
|
|
|
|
|
- // initCubicPoly
|
|
|
|
- this.init( x1, x2, t1, t2 );
|
|
|
|
|
|
+ initNonuniformCatmullRom: function ( x0, x1, x2, x3, dt0, dt1, dt2 ) {
|
|
|
|
|
|
- };
|
|
|
|
|
|
+ // compute tangents when parameterized in [t1,t2]
|
|
|
|
+ var t1 = ( x1 - x0 ) / dt0 - ( x2 - x0 ) / ( dt0 + dt1 ) + ( x2 - x1 ) / dt1;
|
|
|
|
+ var t2 = ( x2 - x1 ) / dt1 - ( x3 - x1 ) / ( dt1 + dt2 ) + ( x3 - x2 ) / dt2;
|
|
|
|
|
|
- // standard Catmull-Rom spline: interpolate between x1 and x2 with previous/following points x1/x4
|
|
|
|
- CubicPoly.prototype.initCatmullRom = function( x0, x1, x2, x3, tension ) {
|
|
|
|
|
|
+ // rescale tangents for parametrization in [0,1]
|
|
|
|
+ t1 *= dt1;
|
|
|
|
+ t2 *= dt1;
|
|
|
|
|
|
- this.init( x1, x2, tension * ( x2 - x0 ), tension * ( x3 - x1 ) );
|
|
|
|
|
|
+ init( x1, x2, t1, t2 );
|
|
|
|
|
|
- };
|
|
|
|
|
|
+ },
|
|
|
|
|
|
- CubicPoly.prototype.calc = function( t ) {
|
|
|
|
|
|
+ calc: function ( t ) {
|
|
|
|
|
|
- var t2 = t * t;
|
|
|
|
- var t3 = t2 * t;
|
|
|
|
- return this.c0 + this.c1 * t + this.c2 * t2 + this.c3 * t3;
|
|
|
|
|
|
+ var t2 = t * t;
|
|
|
|
+ var t3 = t2 * t;
|
|
|
|
+ return c0 + c1 * t + c2 * t2 + c3 * t3;
|
|
|
|
|
|
- };
|
|
|
|
|
|
+ }
|
|
|
|
|
|
- // Subclass Three.js curve
|
|
|
|
- return Curve.create(
|
|
|
|
|
|
+ };
|
|
|
|
|
|
- function ( p /* array of Vector3 */ ) {
|
|
|
|
|
|
+}
|
|
|
|
|
|
- this.points = p || [];
|
|
|
|
- this.closed = false;
|
|
|
|
|
|
+//
|
|
|
|
|
|
- },
|
|
|
|
|
|
+var tmp = new Vector3();
|
|
|
|
+var px = new CubicPoly(), py = new CubicPoly(), pz = new CubicPoly();
|
|
|
|
|
|
- function ( t ) {
|
|
|
|
|
|
+function CatmullRomCurve3( p /* array of Vector3 */ ) {
|
|
|
|
|
|
- var points = this.points,
|
|
|
|
- point, intPoint, weight, l;
|
|
|
|
|
|
+ this.points = p || [];
|
|
|
|
+ this.closed = false;
|
|
|
|
|
|
- l = points.length;
|
|
|
|
|
|
+}
|
|
|
|
|
|
- if ( l < 2 ) console.log( 'duh, you need at least 2 points' );
|
|
|
|
|
|
+CatmullRomCurve3.prototype = Object.create( Curve.prototype );
|
|
|
|
+CatmullRomCurve3.prototype.constructor = CatmullRomCurve3;
|
|
|
|
|
|
- point = ( l - ( this.closed ? 0 : 1 ) ) * t;
|
|
|
|
- intPoint = Math.floor( point );
|
|
|
|
- weight = point - intPoint;
|
|
|
|
|
|
+CatmullRomCurve3.prototype.getPoint = function ( t ) {
|
|
|
|
|
|
- if ( this.closed ) {
|
|
|
|
|
|
+ var points = this.points;
|
|
|
|
+ var l = points.length;
|
|
|
|
|
|
- intPoint += intPoint > 0 ? 0 : ( Math.floor( Math.abs( intPoint ) / points.length ) + 1 ) * points.length;
|
|
|
|
|
|
+ if ( l < 2 ) console.log( 'duh, you need at least 2 points' );
|
|
|
|
|
|
- } else if ( weight === 0 && intPoint === l - 1 ) {
|
|
|
|
|
|
+ var point = ( l - ( this.closed ? 0 : 1 ) ) * t;
|
|
|
|
+ var intPoint = Math.floor( point );
|
|
|
|
+ var weight = point - intPoint;
|
|
|
|
|
|
- intPoint = l - 2;
|
|
|
|
- weight = 1;
|
|
|
|
|
|
+ if ( this.closed ) {
|
|
|
|
|
|
- }
|
|
|
|
|
|
+ intPoint += intPoint > 0 ? 0 : ( Math.floor( Math.abs( intPoint ) / points.length ) + 1 ) * points.length;
|
|
|
|
|
|
- var p0, p1, p2, p3; // 4 points
|
|
|
|
|
|
+ } else if ( weight === 0 && intPoint === l - 1 ) {
|
|
|
|
|
|
- if ( this.closed || intPoint > 0 ) {
|
|
|
|
|
|
+ intPoint = l - 2;
|
|
|
|
+ weight = 1;
|
|
|
|
|
|
- p0 = points[ ( intPoint - 1 ) % l ];
|
|
|
|
|
|
+ }
|
|
|
|
|
|
- } else {
|
|
|
|
|
|
+ var p0, p1, p2, p3; // 4 points
|
|
|
|
|
|
- // extrapolate first point
|
|
|
|
- tmp.subVectors( points[ 0 ], points[ 1 ] ).add( points[ 0 ] );
|
|
|
|
- p0 = tmp;
|
|
|
|
|
|
+ if ( this.closed || intPoint > 0 ) {
|
|
|
|
|
|
- }
|
|
|
|
|
|
+ p0 = points[ ( intPoint - 1 ) % l ];
|
|
|
|
|
|
- p1 = points[ intPoint % l ];
|
|
|
|
- p2 = points[ ( intPoint + 1 ) % l ];
|
|
|
|
|
|
+ } else {
|
|
|
|
|
|
- if ( this.closed || intPoint + 2 < l ) {
|
|
|
|
|
|
+ // extrapolate first point
|
|
|
|
+ tmp.subVectors( points[ 0 ], points[ 1 ] ).add( points[ 0 ] );
|
|
|
|
+ p0 = tmp;
|
|
|
|
|
|
- p3 = points[ ( intPoint + 2 ) % l ];
|
|
|
|
|
|
+ }
|
|
|
|
|
|
- } else {
|
|
|
|
|
|
+ p1 = points[ intPoint % l ];
|
|
|
|
+ p2 = points[ ( intPoint + 1 ) % l ];
|
|
|
|
|
|
- // extrapolate last point
|
|
|
|
- tmp.subVectors( points[ l - 1 ], points[ l - 2 ] ).add( points[ l - 1 ] );
|
|
|
|
- p3 = tmp;
|
|
|
|
|
|
+ if ( this.closed || intPoint + 2 < l ) {
|
|
|
|
|
|
- }
|
|
|
|
|
|
+ p3 = points[ ( intPoint + 2 ) % l ];
|
|
|
|
|
|
- if ( this.type === undefined || this.type === 'centripetal' || this.type === 'chordal' ) {
|
|
|
|
|
|
+ } else {
|
|
|
|
|
|
- // init Centripetal / Chordal Catmull-Rom
|
|
|
|
- var pow = this.type === 'chordal' ? 0.5 : 0.25;
|
|
|
|
- var dt0 = Math.pow( p0.distanceToSquared( p1 ), pow );
|
|
|
|
- var dt1 = Math.pow( p1.distanceToSquared( p2 ), pow );
|
|
|
|
- var dt2 = Math.pow( p2.distanceToSquared( p3 ), pow );
|
|
|
|
|
|
+ // extrapolate last point
|
|
|
|
+ tmp.subVectors( points[ l - 1 ], points[ l - 2 ] ).add( points[ l - 1 ] );
|
|
|
|
+ p3 = tmp;
|
|
|
|
|
|
- // safety check for repeated points
|
|
|
|
- if ( dt1 < 1e-4 ) dt1 = 1.0;
|
|
|
|
- if ( dt0 < 1e-4 ) dt0 = dt1;
|
|
|
|
- if ( dt2 < 1e-4 ) dt2 = dt1;
|
|
|
|
|
|
+ }
|
|
|
|
|
|
- px.initNonuniformCatmullRom( p0.x, p1.x, p2.x, p3.x, dt0, dt1, dt2 );
|
|
|
|
- py.initNonuniformCatmullRom( p0.y, p1.y, p2.y, p3.y, dt0, dt1, dt2 );
|
|
|
|
- pz.initNonuniformCatmullRom( p0.z, p1.z, p2.z, p3.z, dt0, dt1, dt2 );
|
|
|
|
|
|
+ if ( this.type === undefined || this.type === 'centripetal' || this.type === 'chordal' ) {
|
|
|
|
|
|
- } else if ( this.type === 'catmullrom' ) {
|
|
|
|
|
|
+ // init Centripetal / Chordal Catmull-Rom
|
|
|
|
+ var pow = this.type === 'chordal' ? 0.5 : 0.25;
|
|
|
|
+ var dt0 = Math.pow( p0.distanceToSquared( p1 ), pow );
|
|
|
|
+ var dt1 = Math.pow( p1.distanceToSquared( p2 ), pow );
|
|
|
|
+ var dt2 = Math.pow( p2.distanceToSquared( p3 ), pow );
|
|
|
|
|
|
- var tension = this.tension !== undefined ? this.tension : 0.5;
|
|
|
|
- px.initCatmullRom( p0.x, p1.x, p2.x, p3.x, tension );
|
|
|
|
- py.initCatmullRom( p0.y, p1.y, p2.y, p3.y, tension );
|
|
|
|
- pz.initCatmullRom( p0.z, p1.z, p2.z, p3.z, tension );
|
|
|
|
|
|
+ // safety check for repeated points
|
|
|
|
+ if ( dt1 < 1e-4 ) dt1 = 1.0;
|
|
|
|
+ if ( dt0 < 1e-4 ) dt0 = dt1;
|
|
|
|
+ if ( dt2 < 1e-4 ) dt2 = dt1;
|
|
|
|
|
|
- }
|
|
|
|
|
|
+ px.initNonuniformCatmullRom( p0.x, p1.x, p2.x, p3.x, dt0, dt1, dt2 );
|
|
|
|
+ py.initNonuniformCatmullRom( p0.y, p1.y, p2.y, p3.y, dt0, dt1, dt2 );
|
|
|
|
+ pz.initNonuniformCatmullRom( p0.z, p1.z, p2.z, p3.z, dt0, dt1, dt2 );
|
|
|
|
|
|
- var v = new Vector3(
|
|
|
|
- px.calc( weight ),
|
|
|
|
- py.calc( weight ),
|
|
|
|
- pz.calc( weight )
|
|
|
|
- );
|
|
|
|
|
|
+ } else if ( this.type === 'catmullrom' ) {
|
|
|
|
|
|
- return v;
|
|
|
|
|
|
+ var tension = this.tension !== undefined ? this.tension : 0.5;
|
|
|
|
+ px.initCatmullRom( p0.x, p1.x, p2.x, p3.x, tension );
|
|
|
|
+ py.initCatmullRom( p0.y, p1.y, p2.y, p3.y, tension );
|
|
|
|
+ pz.initCatmullRom( p0.z, p1.z, p2.z, p3.z, tension );
|
|
|
|
|
|
- }
|
|
|
|
|
|
+ }
|
|
|
|
|
|
- );
|
|
|
|
|
|
+ return new Vector3( px.calc( weight ), py.calc( weight ), pz.calc( weight ) );
|
|
|
|
|
|
-} )();
|
|
|
|
|
|
+};
|
|
|
|
|
|
|
|
|
|
export { CatmullRomCurve3 };
|
|
export { CatmullRomCurve3 };
|