To work with current implementation of fe_perpendicular.
)
{
std::vector<BicycleCar> pi;
- if (!this->ps().parallel()) {
- this->cc().sp(this->cc().sp() * -dist);
- this->cc().st(this->cc().st() * -1);
- } else {
- this->cc().sp(this->cc().sp() * dist);
- this->cc().st(this->cc().st() * 1);
- }
+ this->cc().sp(this->cc().sp() * dist);
+ this->cc().st(this->cc().st() * 1);
BicycleCar orig_cc(this->cc());
for (unsigned int i = 0; i < cnt; i++) {
this->cc().next();