unconstr_ocp_data.hpp

Go to the documentation of this file.

#ifndef ROBOTOC_UNCONSTR_OCP_DATA_HPP_
#define ROBOTOC_UNCONSTR_OCP_DATA_HPP_
 
#include "robotoc/core/performance_index.hpp"
#include "robotoc/cost/cost_function_data.hpp"
#include "robotoc/constraints/constraints_data.hpp"
#include "robotoc/dynamics/unconstr_dynamics.hpp"
 
 
namespace robotoc {
 
struct UnconstrOCPData {
  PerformanceIndex performance_index;
 
  CostFunctionData cost_data;
 
  ConstraintsData constraints_data;
 
  UnconstrDynamics unconstr_dynamics;
 
  template <int p=1>
  double primalFeasibility() const {
    double feasibility = 0;
    feasibility += constraints_data.template primalFeasibility<p>();
    feasibility += unconstr_dynamics.template primalFeasibility<p>();
    return feasibility;
  }
 
  template <int p=1>
  double dualFeasibility() const {
    double feasibility = 0;
    feasibility += constraints_data.template dualFeasibility<p>();
    return feasibility;
  }
 
  double KKTError() const {
    double error = 0;
    error += constraints_data.KKTError();
    error += unconstr_dynamics.KKTError();
    return error;
  }
};
 
} // namespace robotoc
 
#endif // ROBOTOC_UNCONSTR_OCP_DATA_HPP_