hc_cc_circle.hpp

Go to the documentation of this file.

/*********************************************************************
*  Copyright (c) 2017 - for information on the respective copyright
*  owner see the NOTICE file and/or the repository
*
*      https://github.com/hbanzhaf/steering_functions.git
*
*  Licensed under the Apache License, Version 2.0 (the "License");
*  you may not use this file except in compliance with the License.
*  You may obtain a copy of the License at
*
*      http://www.apache.org/licenses/LICENSE-2.0
*
*  Unless required by applicable law or agreed to in writing, software
*  distributed under the License is distributed on an "AS IS" BASIS,
*  WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or
*  implied. See the License for the specific language governing
*  permissions and limitations under the License.
 
*  This source code is derived from Continuous Curvature (CC) Steer.
*  Copyright (c) 2016, Thierry Fraichard and Institut national de
*  recherche en informatique et en automatique (Inria), licensed under
*  the BSD license, cf. 3rd-party-licenses.txt file in the root
*  directory of this source tree.
**********************************************************************/
 
#ifndef HC_CC_CIRCLE_HPP
#define HC_CC_CIRCLE_HPP
 
#include "steering_functions/hc_cc_state_space/configuration.hpp"
 
namespace steering
{
 
class HC_CC_Circle_Param
{
public:
  void set_param(double _kappa, double _sigma, double _radius, double _mu, double _sin_mu, double _cos_mu,
                 double _delta_min);
 
  double kappa, kappa_inv, sigma;
 
  double radius;
 
  double mu;
 
  double sin_mu, cos_mu;
 
  double delta_min;
};
 
class HC_CC_Circle : public HC_CC_Circle_Param
{
public:
  HC_CC_Circle(const Configuration &_start, bool _left, bool _forward, bool _regular, const HC_CC_Circle_Param &_param);
 
  HC_CC_Circle(double _xc, double _yc, bool _left, bool _forward, bool _regular, const HC_CC_Circle_Param &_param);
 
  double deflection(const Configuration &q) const;
 
  double D1(double alpha) const;
 
  double rs_circular_deflection(double delta) const;
 
  double rs_turn_length(const Configuration &q) const;
 
  double hc_circular_deflection(double delta) const;
 
  double hc_turn_length(const Configuration &q) const;
 
  bool cc_elementary_sharpness(const Configuration &q, double delta, double &sigma0) const;
 
  double cc_circular_deflection(double delta) const;
 
  double cc_turn_length(const Configuration &q) const;
 
  void print(bool eol) const;
 
  Configuration start;
 
  bool left;
 
  bool forward;
 
  bool regular;
 
  double xc, yc;
};
 
double center_distance(const HC_CC_Circle &c1, const HC_CC_Circle &c2);
 
bool configuration_on_hc_cc_circle(const HC_CC_Circle &c, const Configuration &q);
 
} // namespace steering
 
#endif