diff options
Diffstat (limited to 'scene/resources/curve.cpp')
-rw-r--r-- | scene/resources/curve.cpp | 587 |
1 files changed, 414 insertions, 173 deletions
diff --git a/scene/resources/curve.cpp b/scene/resources/curve.cpp index f39bbf4c4e..ae2c07ff56 100644 --- a/scene/resources/curve.cpp +++ b/scene/resources/curve.cpp @@ -44,6 +44,7 @@ static _FORCE_INLINE_ T _bezier_interp(real_t t, T start, T control_1, T control + end * t3; } +#if 0 int Curve2D::get_point_count() const { @@ -379,21 +380,16 @@ Curve2D::Curve2D() { } +#endif -/***********************************************************************************/ -/***********************************************************************************/ -/***********************************************************************************/ -/***********************************************************************************/ -/***********************************************************************************/ -/***********************************************************************************/ -int Curve3D::get_point_count() const { +int Curve2D::get_point_count() const { return points.size(); } -void Curve3D::add_point(const Vector3& p_pos, const Vector3& p_in, const Vector3& p_out,int p_atpos) { +void Curve2D::add_point(const Vector2& p_pos, const Vector2& p_in, const Vector2& p_out,int p_atpos) { Point n; n.pos=p_pos; @@ -408,7 +404,8 @@ void Curve3D::add_point(const Vector3& p_pos, const Vector3& p_in, const Vector3 baked_cache_dirty=true; emit_signal(CoreStringNames::get_singleton()->changed); } -void Curve3D::set_point_pos(int p_index, const Vector3& p_pos) { + +void Curve2D::set_point_pos(int p_index, const Vector2& p_pos) { ERR_FAIL_INDEX(p_index,points.size()); @@ -417,31 +414,15 @@ void Curve3D::set_point_pos(int p_index, const Vector3& p_pos) { emit_signal(CoreStringNames::get_singleton()->changed); } -Vector3 Curve3D::get_point_pos(int p_index) const { +Vector2 Curve2D::get_point_pos(int p_index) const { - ERR_FAIL_INDEX_V(p_index,points.size(),Vector3()); + ERR_FAIL_INDEX_V(p_index,points.size(),Vector2()); return points[p_index].pos; } -void Curve3D::set_point_tilt(int p_index, float p_tilt) { - - ERR_FAIL_INDEX(p_index,points.size()); - - points[p_index].tilt=p_tilt; - baked_cache_dirty=true; - emit_signal(CoreStringNames::get_singleton()->changed); - -} -float Curve3D::get_point_tilt(int p_index) const { - - ERR_FAIL_INDEX_V(p_index,points.size(),0); - return points[p_index].tilt; -} - - -void Curve3D::set_point_in(int p_index, const Vector3& p_in) { +void Curve2D::set_point_in(int p_index, const Vector2& p_in) { ERR_FAIL_INDEX(p_index,points.size()); @@ -450,14 +431,14 @@ void Curve3D::set_point_in(int p_index, const Vector3& p_in) { emit_signal(CoreStringNames::get_singleton()->changed); } -Vector3 Curve3D::get_point_in(int p_index) const { +Vector2 Curve2D::get_point_in(int p_index) const { - ERR_FAIL_INDEX_V(p_index,points.size(),Vector3()); + ERR_FAIL_INDEX_V(p_index,points.size(),Vector2()); return points[p_index].in; } -void Curve3D::set_point_out(int p_index, const Vector3& p_out) { +void Curve2D::set_point_out(int p_index, const Vector2& p_out) { ERR_FAIL_INDEX(p_index,points.size()); @@ -467,15 +448,15 @@ void Curve3D::set_point_out(int p_index, const Vector3& p_out) { } -Vector3 Curve3D::get_point_out(int p_index) const { +Vector2 Curve2D::get_point_out(int p_index) const { - ERR_FAIL_INDEX_V(p_index,points.size(),Vector3()); + ERR_FAIL_INDEX_V(p_index,points.size(),Vector2()); return points[p_index].out; } -void Curve3D::remove_point(int p_index) { +void Curve2D::remove_point(int p_index) { ERR_FAIL_INDEX(p_index,points.size()); points.remove(p_index); @@ -483,25 +464,25 @@ void Curve3D::remove_point(int p_index) { emit_signal(CoreStringNames::get_singleton()->changed); } -Vector3 Curve3D::interpolate(int p_index, float p_offset) const { +Vector2 Curve2D::interpolate(int p_index, float p_offset) const { int pc = points.size(); - ERR_FAIL_COND_V(pc==0,Vector3()); + ERR_FAIL_COND_V(pc==0,Vector2()); if (p_index >= pc-1) return points[pc-1].pos; else if (p_index<0) return points[0].pos; - Vector3 p0 = points[p_index].pos; - Vector3 p1 = p0+points[p_index].out; - Vector3 p3 = points[p_index+1].pos; - Vector3 p2 = p3+points[p_index+1].in; + Vector2 p0 = points[p_index].pos; + Vector2 p1 = p0+points[p_index].out; + Vector2 p3 = points[p_index+1].pos; + Vector2 p2 = p3+points[p_index+1].in; return _bezier_interp(p_offset,p0,p1,p2,p3); } -Vector3 Curve3D::interpolatef(real_t p_findex) const { +Vector2 Curve2D::interpolatef(real_t p_findex) const { if (p_findex>0) @@ -513,216 +494,476 @@ Vector3 Curve3D::interpolatef(real_t p_findex) const { } -#if 0 -DVector<Point3> Curve3D::bake(int p_subdivs) const { - int pc = points.size(); +void Curve2D::_bake_segment2d(Map<float,Vector2>& r_bake, float p_begin, float p_end,const Vector2& p_a,const Vector2& p_out,const Vector2& p_b, const Vector2& p_in,int p_depth,int p_max_depth,float p_tol) const { - DVector<Point3> ret; - if (pc<3) - return ret; + float mp = p_begin+(p_end-p_begin)*0.5; + Vector2 beg = _bezier_interp(p_begin,p_a,p_a+p_out,p_b+p_in,p_b); + Vector2 mid = _bezier_interp(mp,p_a,p_a+p_out,p_b+p_in,p_b); + Vector2 end = _bezier_interp(p_end,p_a,p_a+p_out,p_b+p_in,p_b); - ret.resize((pc-1)*p_subdivs+1); + Vector2 na = (mid-beg).normalized(); + Vector2 nb = (end-mid).normalized(); + float dp = na.dot(nb); - DVector<Point3>::Write w = ret.write(); - const Point *r = points.ptr(); + if (dp<Math::cos(Math::deg2rad(p_tol))) { - for(int i=0;i<pc;i++) { + r_bake[mp]=mid; + } - int ofs = pc*p_subdivs; + if (p_depth<p_max_depth) { + _bake_segment2d(r_bake,p_begin,mp,p_a,p_out,p_b,p_in,p_depth+1,p_max_depth,p_tol); + _bake_segment2d(r_bake,mp,p_end,p_a,p_out,p_b,p_in,p_depth+1,p_max_depth,p_tol); + } +} - int limit=(i==pc-1)?p_subdivs+1:p_subdivs; - for(int j=0;j<limit;j++) { - Vector3 p0 = r[i].pos; - Vector3 p1 = p0+r[i].out; - Vector3 p3 = r[i].pos; - Vector3 p3 = p3+r[i].in; - real_t t = j/(real_t)p_subdivs; +void Curve2D::_bake() const { - w[ofs+j]=_bezier_interp(t,p0,p1,p3,p3); + if (!baked_cache_dirty) + return; - } + baked_max_ofs=0; + baked_cache_dirty=false; + + if (points.size()==0) { + baked_point_cache.resize(0); + return; } - w = DVector<Point3>::Write(); + if (points.size()==1) { - return ret; -} + baked_point_cache.resize(1); + baked_point_cache.set(0,points[0].pos); + return; + } + Vector2 pos=points[0].pos; + int point=0; + float ofs=0; + List<Vector2> pointlist; -void Curve3D::advance(real_t p_distance,int &r_index, real_t &r_pos) const { - int pc = points.size(); - ERR_FAIL_COND(pc<3); - if (r_index<0 || r_index>=(pc-1)) - return; + for(int i=0;i<points.size()-1;i++) { - Vector3 pos = interpolate(r_index,r_pos); + float slen=points[i].pos.distance_to(points[i+1].pos); + float divs = slen / bake_interval; + if (divs>1) + divs=1; - float sign=p_distance<0 ? -1 : 1; - p_distance=Math::abs(p_distance); + float step = divs*0.1; // 10 substeps ought to be enough? + float p = 0; - real_t base = r_index+r_pos; - real_t top = 0.1; //a tenth is in theory representative - int iterations=33; + while(p<1.0) { + float np=p+step; + if (np>1.0) + np=1.0; - for(int i=0;i<iterations;i++) { + Vector2 npp = _bezier_interp(np, points[i].pos,points[i].pos+points[i].out,points[i+1].pos+points[i+1].in,points[i+1].pos); + float d = pos.distance_to(npp); + if (d>bake_interval) { + // OK! between P and NP there _has_ to be Something, let's go searching! + + int iterations = 10; //lots of detail! + + float low = p; + float hi = np; + float mid = low+(hi-low)*0.5; + + for(int j=0;j<iterations;j++) { + + + npp = _bezier_interp(mid, points[i].pos,points[i].pos+points[i].out,points[i+1].pos+points[i+1].in,points[i+1].pos); + d = pos.distance_to(npp); + + if (bake_interval < d) + hi=mid; + else + low=mid; + mid = low+(hi-low)*0.5; + + } + + pos=npp; + p=mid; + pointlist.push_back(pos); + } else { + + p=np; + } - real_t o=base+top*sign; - if (sign>0 && o >=pc) { - top=pc-base; - break; - } else if (sign<0 && o <0) { - top=-base; - break; } + } - Vector3 new_d = interpolatef(o); + Vector2 lastpos = points[points.size()-1].pos; - if (new_d.distance_to(pos) > p_distance) - break; - top*=3.0; + + float rem = pos.distance_to(lastpos); + baked_max_ofs=(pointlist.size()-1)*bake_interval+rem; + pointlist.push_back(lastpos); + + baked_point_cache.resize(pointlist.size()); + Vector2Array::Write w = baked_point_cache.write(); + int idx=0; + + + for(List<Vector2>::Element *E=pointlist.front();E;E=E->next()) { + + w[idx]=E->get(); + idx++; } +} - real_t bottom = 0.0; - iterations=8; - real_t final_offset; +float Curve2D::get_baked_length() const { + if (baked_cache_dirty) + _bake(); - for(int i=0;i<iterations;i++) { + return baked_max_ofs; +} +Vector2 Curve2D::interpolate_baked(float p_offset,bool p_cubic) const{ - real_t middle = (bottom+top)*0.5; - real_t o=base+middle*sign; - Vector3 new_d = interpolatef(o); + if (baked_cache_dirty) + _bake(); - if (new_d.distance_to(pos) > p_distance) { - bottom=middle; - } else { - top=middle; - } - final_offset=o; + //validate// + int pc = baked_point_cache.size(); + if (pc==0) { + ERR_EXPLAIN("No points in Curve2D"); + ERR_FAIL_COND_V(pc==0,Vector2()); } - r_index=(int)final_offset; - r_pos=Math::fmod(final_offset,1.0); + if (pc==1) + return baked_point_cache.get(0); + + int bpc=baked_point_cache.size(); + Vector2Array::Read r = baked_point_cache.read(); + + if (p_offset<0) + return r[0]; + if (p_offset>=baked_max_ofs) + return r[bpc-1]; + + int idx = Math::floor(p_offset/bake_interval); + float frac = Math::fmod(p_offset,bake_interval); + + if (idx>=bpc-1) { + return r[bpc-1]; + } else if (idx==bpc-2) { + frac/=Math::fmod(baked_max_ofs,bake_interval); + } else { + frac/=bake_interval; + } + + if (p_cubic) { + + Vector2 pre = idx>0? r[idx-1] : r[idx]; + Vector2 post = (idx<(bpc-2))? r[idx+2] : r[idx+1]; + return r[idx].cubic_interpolate(r[idx+1],pre,post,frac); + } else { + return r[idx].linear_interpolate(r[idx+1],frac); + } +} + +Vector2Array Curve2D::get_baked_points() const { + + if (baked_cache_dirty) + _bake(); + + return baked_point_cache; } -void Curve3D::get_approx_position_from_offset(real_t p_offset,int &r_index, real_t &r_pos,int p_subdivs) const { +void Curve2D::set_bake_interval(float p_tolerance){ + + bake_interval=p_tolerance; + baked_cache_dirty=true; + emit_signal(CoreStringNames::get_singleton()->changed); + +} - ERR_FAIL_COND(points.size()<3); +float Curve2D::get_bake_interval() const{ - real_t accum=0; + return bake_interval; +} +Dictionary Curve2D::_get_data() const { + + Dictionary dc; + + Vector2Array d; + d.resize(points.size()*3); + Vector2Array::Write w = d.write(); for(int i=0;i<points.size();i++) { - Vector3 prev_p=interpolate(i,0); + w[i*3+0]=points[i].in; + w[i*3+1]=points[i].out; + w[i*3+2]=points[i].pos; + } - for(int j=1;j<=p_subdivs;j++) { + w=Vector2Array::Write(); - real_t frac = j/(real_t)p_subdivs; - Vector3 p = interpolate(i,frac); - real_t d = p.distance_to(prev_p); + dc["points"]=d; - accum+=d; - if (accum>p_offset) { + return dc; +} +void Curve2D::_set_data(const Dictionary& p_data){ - r_index=j-1; - if (d>0) { - real_t mf = (p_offset-(accum-d)) / d; - r_pos=frac-(1.0-mf); - } else { - r_pos=frac; - } + ERR_FAIL_COND(!p_data.has("points")); - return; - } + Vector2Array rp=p_data["points"]; + int pc = rp.size(); + ERR_FAIL_COND(pc%3!=0); + points.resize(pc/3); + Vector2Array::Read r = rp.read(); - prev_p=p; + for(int i=0;i<points.size();i++) { + + points[i].in=r[i*3+0]; + points[i].out=r[i*3+1]; + points[i].pos=r[i*3+2]; + } + + baked_cache_dirty=true; + +} + + +Vector2Array Curve2D::tesselate(int p_max_stages,float p_tolerance) const { + + Vector2Array tess; + + + if (points.size()==0) { + return tess; + } + Vector< Map<float,Vector2> > midpoints; + + midpoints.resize(points.size()-1); + + int pc=1; + for(int i=0;i<points.size()-1;i++) { + + _bake_segment2d(midpoints[i],0,1,points[i].pos,points[i].out,points[i+1].pos,points[i+1].in,0,p_max_stages,p_tolerance); + pc++; + pc+=midpoints[i].size(); + + } + + tess.resize(pc); + Vector2Array::Write bpw=tess.write(); + bpw[0]=points[0].pos; + int pidx=0; + + for(int i=0;i<points.size()-1;i++) { + + for(Map<float,Vector2>::Element *E=midpoints[i].front();E;E=E->next()) { + + pidx++; + bpw[pidx] = E->get(); } + + pidx++; + bpw[pidx] = points[i+1].pos; + } - r_index=points.size()-1; - r_pos=1.0; + bpw=Vector2Array::Write (); + return tess; } +void Curve2D::_bind_methods() { -void Curve3D::set_points_in(const Vector3Array& p_points) { + ObjectTypeDB::bind_method(_MD("get_point_count"),&Curve2D::get_point_count); + ObjectTypeDB::bind_method(_MD("add_point","pos","in","out","atpos"),&Curve2D::add_point,DEFVAL(Vector2()),DEFVAL(Vector2()),DEFVAL(-1)); + ObjectTypeDB::bind_method(_MD("set_point_pos","idx","pos"),&Curve2D::set_point_pos); + ObjectTypeDB::bind_method(_MD("get_point_pos","idx"),&Curve2D::get_point_pos); + ObjectTypeDB::bind_method(_MD("set_point_in","idx","pos"),&Curve2D::set_point_in); + ObjectTypeDB::bind_method(_MD("get_point_in","idx"),&Curve2D::get_point_in); + ObjectTypeDB::bind_method(_MD("set_point_out","idx","pos"),&Curve2D::set_point_out); + ObjectTypeDB::bind_method(_MD("get_point_out","idx"),&Curve2D::get_point_out); + ObjectTypeDB::bind_method(_MD("remove_point","idx"),&Curve2D::remove_point); + ObjectTypeDB::bind_method(_MD("interpolate","idx","t"),&Curve2D::interpolate); + ObjectTypeDB::bind_method(_MD("interpolatef","fofs"),&Curve2D::interpolatef); + //ObjectTypeDB::bind_method(_MD("bake","subdivs"),&Curve2D::bake,DEFVAL(10)); + ObjectTypeDB::bind_method(_MD("set_bake_interval","distance"),&Curve2D::set_bake_interval); + ObjectTypeDB::bind_method(_MD("get_bake_interval"),&Curve2D::get_bake_interval); - points.resize(p_points.size()); - for (int i=0; i<p_points.size(); i++) { + ObjectTypeDB::bind_method(_MD("get_baked_length"),&Curve2D::get_baked_length); + ObjectTypeDB::bind_method(_MD("interpolate_baked","offset","cubic"),&Curve2D::interpolate_baked,DEFVAL(false)); + ObjectTypeDB::bind_method(_MD("get_baked_points"),&Curve2D::get_baked_points); - Point p = points[i]; - p.in = p_points[i]; - points[i] = p; - }; -}; + ObjectTypeDB::bind_method(_MD("_get_data"),&Curve2D::_get_data); + ObjectTypeDB::bind_method(_MD("_set_data"),&Curve2D::_set_data); -void Curve3D::set_points_out(const Vector3Array& p_points) { - points.resize(p_points.size()); - for (int i=0; i<p_points.size(); i++) { + ADD_PROPERTY( PropertyInfo( Variant::REAL, "bake_interval",PROPERTY_HINT_RANGE,"0.01,512,0.01"), _SCS("set_bake_interval"),_SCS("get_bake_interval")); + ADD_PROPERTY( PropertyInfo( Variant::INT, "_data",PROPERTY_HINT_NONE,"",PROPERTY_USAGE_NOEDITOR), _SCS("_set_data"),_SCS("_get_data")); + /*ADD_PROPERTY( PropertyInfo( Variant::VECTOR3_ARRAY, "points_out"), _SCS("set_points_out"),_SCS("get_points_out")); + ADD_PROPERTY( PropertyInfo( Variant::VECTOR3_ARRAY, "points_pos"), _SCS("set_points_pos"),_SCS("get_points_pos")); +*/ +} - Point p = points[i]; - p.out = p_points[i]; - points[i] = p; - }; -}; -void Curve3D::set_points_pos(const Vector3Array& p_points) { - points.resize(p_points.size()); - for (int i=0; i<p_points.size(); i++) { - Point p = points[i]; - p.pos = p_points[i]; - points[i] = p; - }; -}; +Curve2D::Curve2D() +{ + baked_cache_dirty=false; + baked_max_ofs=0; +/* add_point(Vector2(-1,0,0)); + add_point(Vector2(0,2,0)); + add_point(Vector2(0,3,5));*/ + bake_interval=5; -Vector3Array Curve3D::get_points_in() const { - Vector3Array ret; - ret.resize(points.size()); - for (int i=0; i<points.size(); i++) { - ret.set(i, points[i].in); - }; - return ret; -}; +} -Vector3Array Curve3D::get_points_out() const { - Vector3Array ret; - ret.resize(points.size()); - for (int i=0; i<points.size(); i++) { - ret.set(i, points[i].out); - }; - return ret; -}; -Vector3Array Curve3D::get_points_pos() const { - Vector3Array ret; - ret.resize(points.size()); - for (int i=0; i<points.size(); i++) { - ret.set(i, points[i].pos); - }; - return ret; -}; -#endif +/***********************************************************************************/ +/***********************************************************************************/ +/***********************************************************************************/ +/***********************************************************************************/ +/***********************************************************************************/ +/***********************************************************************************/ + +int Curve3D::get_point_count() const { + + return points.size(); +} +void Curve3D::add_point(const Vector3& p_pos, const Vector3& p_in, const Vector3& p_out,int p_atpos) { + + Point n; + n.pos=p_pos; + n.in=p_in; + n.out=p_out; + if (p_atpos>=0 && p_atpos<points.size()) + points.insert(p_atpos,n); + else + points.push_back(n); + + + baked_cache_dirty=true; + emit_signal(CoreStringNames::get_singleton()->changed); +} +void Curve3D::set_point_pos(int p_index, const Vector3& p_pos) { + + ERR_FAIL_INDEX(p_index,points.size()); + + points[p_index].pos=p_pos; + baked_cache_dirty=true; + emit_signal(CoreStringNames::get_singleton()->changed); + +} +Vector3 Curve3D::get_point_pos(int p_index) const { + + ERR_FAIL_INDEX_V(p_index,points.size(),Vector3()); + return points[p_index].pos; + +} + +void Curve3D::set_point_tilt(int p_index, float p_tilt) { + + ERR_FAIL_INDEX(p_index,points.size()); + + points[p_index].tilt=p_tilt; + baked_cache_dirty=true; + emit_signal(CoreStringNames::get_singleton()->changed); + +} +float Curve3D::get_point_tilt(int p_index) const { + + ERR_FAIL_INDEX_V(p_index,points.size(),0); + return points[p_index].tilt; + +} + + +void Curve3D::set_point_in(int p_index, const Vector3& p_in) { + + ERR_FAIL_INDEX(p_index,points.size()); + + points[p_index].in=p_in; + baked_cache_dirty=true; + emit_signal(CoreStringNames::get_singleton()->changed); + +} +Vector3 Curve3D::get_point_in(int p_index) const { + + ERR_FAIL_INDEX_V(p_index,points.size(),Vector3()); + return points[p_index].in; + +} + +void Curve3D::set_point_out(int p_index, const Vector3& p_out) { + + ERR_FAIL_INDEX(p_index,points.size()); + + points[p_index].out=p_out; + baked_cache_dirty=true; + emit_signal(CoreStringNames::get_singleton()->changed); + +} + +Vector3 Curve3D::get_point_out(int p_index) const { + + ERR_FAIL_INDEX_V(p_index,points.size(),Vector3()); + return points[p_index].out; + +} + + +void Curve3D::remove_point(int p_index) { + + ERR_FAIL_INDEX(p_index,points.size()); + points.remove(p_index); + baked_cache_dirty=true; + emit_signal(CoreStringNames::get_singleton()->changed); +} + +Vector3 Curve3D::interpolate(int p_index, float p_offset) const { + + int pc = points.size(); + ERR_FAIL_COND_V(pc==0,Vector3()); + + if (p_index >= pc-1) + return points[pc-1].pos; + else if (p_index<0) + return points[0].pos; + + Vector3 p0 = points[p_index].pos; + Vector3 p1 = p0+points[p_index].out; + Vector3 p3 = points[p_index+1].pos; + Vector3 p2 = p3+points[p_index+1].in; + + return _bezier_interp(p_offset,p0,p1,p2,p3); +} + +Vector3 Curve3D::interpolatef(real_t p_findex) const { + + + if (p_findex>0) + p_findex=0; + else if (p_findex>=points.size()) + p_findex=points.size(); + + return interpolate((int)p_findex,Math::fmod(p_findex,1.0)); + +} void Curve3D::_bake_segment3d(Map<float,Vector3>& r_bake, float p_begin, float p_end,const Vector3& p_a,const Vector3& p_out,const Vector3& p_b, const Vector3& p_in,int p_depth,int p_max_depth,float p_tol) const { |