sf_posreg.mexglx: sf_posreg.cc balet.cc
mex $(CXXFLAGS) $^
-sf_trgen.mexglx: sf_trgen.cc trajectory.cc arc.cc line.cc spline.cc turn.cc
+sf_trgen.mexglx: sf_trgen.cc trajectory.cc line.cc spline.cc turn.cc
mex $(CXXFLAGS) $^
// dCurvature/dDistance = maxCurvature / (length/2) = 2 / (minRadius*length)
vc = fmin(vc, sqrt( constr.maxangacc * (length/2.0*minr) ));
-
+ dbgPrintf("segment %p: vc0=%g\n", this, vc);
#ifdef MATLAB_MEX_FILE
char str [200];
}
printf("MAX %lf, v1 %lf vc %lf v2 %lf acc %lf len %lf ang %lf\n", kkk, v1, vc, v2, acc, length, omega*180/M_PI);
*/
+ dbgPrintf("segment %p: vc1=%g\n", this, vc);
acc = (v2-vc)*(v2+vc)/length;
// acceleration needed
acc = fmin(acc, constr.maxacc);