aboutsummaryrefslogtreecommitdiff
path: root/extensions
diff options
context:
space:
mode:
authorGravatar Chris Xiong <chirs241097@gmail.com> 2015-11-01 23:33:50 +0800
committerGravatar Chris Xiong <chirs241097@gmail.com> 2015-11-01 23:33:50 +0800
commit6655926e01396139f4b81323d8adcc734bc4284e (patch)
treec12d5eee4e30025b3ac7b4600c96b68e8be5dbf4 /extensions
parentbdcabc1e059ba9415e8d1f8cb436c77545680670 (diff)
downloadSMELT-6655926e01396139f4b81323d8adcc734bc4284e.tar.xz
Add smPath source files.
Sync with the latest BLR3.
Diffstat (limited to 'extensions')
-rw-r--r--extensions/smpath.cpp27
1 files changed, 27 insertions, 0 deletions
diff --git a/extensions/smpath.cpp b/extensions/smpath.cpp
new file mode 100644
index 0000000..9d73b4a
--- /dev/null
+++ b/extensions/smpath.cpp
@@ -0,0 +1,27 @@
+#include <cmath>
+#include "smpath.hpp"
+smPathSegment::smPathSegment(smvec2d _a,smvec2d _b){a=_a,b=_b;}
+smvec2d smPathSegment::getPointOnPath(double rt)
+{return a+rt*(b-a);}
+double smPathSegment::getPathLength()
+{return (a-b).l();}
+smPathCircular::smPathCircular(smvec2d _ctr,double _a,double _b,double _r)
+{ctr=_ctr,a=_a,b=_b,r=_r;}
+smvec2d smPathCircular::getPointOnPath(double rt)
+{return smvec2d(ctr.x+r*cos(a+rt*(b-a)),ctr.y+r*sin(a+rt*(b-a)));}
+double smPathCircular::getPathLength()
+{return fabs(a-b)*r;}
+int smPathCollection::pushPath(smPathBase *p){paths[cpaths++]=p;return cpaths-1;}
+smPathBase* smPathCollection::getPath(int pid){return paths[pid];}
+smvec2d smPathCollection::getPointOnCollection(double rt)
+{
+ double l=0.,tl=0.;
+ int i;
+ for(i=0;i<cpaths;++i)l+=paths[i]->getPathLength();
+ for(i=0;i<cpaths;++i)
+ {
+ if(tl+paths[i]->getPathLength()>=l*rt)break;
+ tl+=paths[i]->getPathLength();
+ }
+ return paths[i]->getPointOnPath(rt-tl/l);
+}