basicmrmplanner.h

Go to the documentation of this file.

/********************************************************************************
 * Copyright (C) 2017-2020 German Aerospace Center (DLR). 
 * Eclipse ADORe, Automated Driving Open Research https://eclipse.org/adore
 *
 * This program and the accompanying materials are made available under the 
 * terms of the Eclipse Public License 2.0 which is available at
 * http://www.eclipse.org/legal/epl-2.0.
 *
 * SPDX-License-Identifier: EPL-2.0 
 *
 * Contributors: 
 *   Daniel Heß - initial API and implementation
 ********************************************************************************/
 
#pragma once
#include "mrmplanner.h"
#include "basicconstraintsandreferences.h"
#include <adore/view/alane.h>
#include <adore/params/ap_longitudinal_planner.h>
#include <adore/params/ap_lateral_planner.h>
#include <adore/params/ap_tactical_planner.h>
 
 
namespace adore
{
  namespace fun
  {
 
    template<int K,int P>
    class BasicMRMPlanner:public MRMPlanner<K,P>
    {
      private:
        FollowCenterlineReference followCenterlineReference_;
        LateralAccelerationReference lateralAccelerationReference_;
        LateralJerkReference lateralJerkReference_;
        LateralOffsetConstraintLF lateralOffsetConstraintLFUB_;
        LateralOffsetConstraintLF lateralOffsetConstraintLFLB_;
        HeadingConstraint headingConstraintUB_;
        HeadingConstraint headingConstraintLB_;
        LateralAccelerationConstraint lateralAccelerationConstraintUB_;
        LateralAccelerationConstraint lateralAccelerationConstraintLB_;
      public:
        BasicMRMPlanner(adore::view::ALane* lfv,
                                  adore::params::APLateralPlanner* plat,
                                  adore::params::APTacticalPlanner* ptac,
                                  adore::params::APVehicle* pveh,
                                  adore::params::APTrajectoryGeneration* ptrajectory,
                                  double lateral_i_grid = 0.0)
              : MRMPlanner<K,P>(lfv,plat,pveh,ptrajectory),
                followCenterlineReference_(lfv,lateral_i_grid),
                lateralAccelerationReference_(lfv),
                lateralJerkReference_(lfv),
                lateralOffsetConstraintLFUB_(lfv,pveh,plat,ANominalConstraint::UB),
                lateralOffsetConstraintLFLB_(lfv,pveh,plat,ANominalConstraint::LB),
                headingConstraintUB_(plat,ANominalConstraint::UB),
                headingConstraintLB_(plat,ANominalConstraint::LB),
                lateralAccelerationConstraintUB_(lfv,plat,ANominalConstraint::UB),
                lateralAccelerationConstraintLB_(lfv,plat,ANominalConstraint::LB)
        {
          this->getOffsetSolver().getInformationSet().add(&followCenterlineReference_);
          this->getOffsetSolver().getInformationSet().add(&lateralAccelerationReference_);
          this->getOffsetSolver().getInformationSet().add(&lateralJerkReference_);
          this->getOffsetSolver().getInformationSet().add(&lateralOffsetConstraintLFUB_);
          this->getOffsetSolver().getInformationSet().add(&lateralOffsetConstraintLFLB_);
          this->getOffsetSolver().getInformationSet().add(&headingConstraintUB_);
          this->getOffsetSolver().getInformationSet().add(&headingConstraintLB_);
          this->getOffsetSolver().getInformationSet().add(&lateralAccelerationConstraintUB_);
          this->getOffsetSolver().getInformationSet().add(&lateralAccelerationConstraintLB_);
        }
 
        void addConstraint(ANominalConstraint* constraint)
        {
          this->info_.add(constraint);
        }
 
        void addReference(ANominalReference* reference)
        {
          this->info_.add(reference);
        }
    };
  }
}