cp = world;
if(cp) // bezier curves movement
- org = vectoangles(cp.origin - self.origin); // use the origin of the control point of the next path_corner
+ org = cp.origin - self.origin; // use the origin of the control point of the next path_corner
else // linear movement
- org = vectoangles(targ.origin - self.origin); // use the origin of the next path_corner
+ org = targ.origin - self.origin; // use the origin of the next path_corner
+ org_z = -org_z;
+ org = vectoangles(org);
if(self.wait >= 0) // slow turning
{