Drake
solveLCPmex.cpp File Reference
#include <mex.h>
#include <cmath>
#include <iostream>
#include "drake/util/drakeMexUtil.h"
#include "drake/util/MexWrapper.h"
#include "drake/systems/plants/RigidBodyTree.h"
#include "drake/solvers/fastQP.h"
#include <sstream>
#include "rigidBodyTreeMexConversions.h"
Include dependency graph for solveLCPmex.cpp:

Macros

#define BIG   1e20
 
#define SMALL   1e-8
 

Functions

void getInclusionIndices (vector< bool > const &inclusion, vector< size_t > &indices, bool get_true_indices)
 
template<typename Derived >
void getThresholdInclusion (MatrixBase< Derived > const &values, const double threshold, vector< bool > &below_threshold)
 
size_t getNumTrue (vector< bool > const &bools)
 
bool anyTrue (vector< bool > const &bools)
 
void partitionVector (vector< bool > const &indices, VectorXd const &v, VectorXd &included, VectorXd &excluded)
 
void partitionMatrix (vector< bool > const &indices, MatrixXd const &M, MatrixXd &included, MatrixXd &excluded)
 
void filterByIndices (vector< size_t > const &indices, MatrixXd const &M, MatrixXd &filtered)
 
void filterByIndices (vector< size_t > const &indices, VectorXd const &v, VectorXd &filtered)
 
template<typename DerivedM , typename Derivedw , typename Derivedlb , typename Derivedz >
bool callFastQP (MatrixBase< DerivedM > const &M, MatrixBase< Derivedw > const &w, MatrixBase< Derivedlb > const &lb, vector< bool > &z_inactive, const size_t checkLimit, MatrixBase< Derivedz > &z)
 
void mexFunction (int nlhs, mxArray *plhs[], int nrhs, const mxArray *prhs[])
 

Macro Definition Documentation

#define BIG   1e20
#define SMALL   1e-8

Function Documentation

bool anyTrue ( vector< bool > const &  bools)
inline

Here is the caller graph for this function:

bool callFastQP ( MatrixBase< DerivedM > const &  M,
MatrixBase< Derivedw > const &  w,
MatrixBase< Derivedlb > const &  lb,
vector< bool > &  z_inactive,
const size_t  checkLimit,
MatrixBase< Derivedz > &  z 
)

Here is the call graph for this function:

Here is the caller graph for this function:

void filterByIndices ( vector< size_t > const &  indices,
MatrixXd const &  M,
MatrixXd &  filtered 
)
inline

Here is the caller graph for this function:

void filterByIndices ( vector< size_t > const &  indices,
VectorXd const &  v,
VectorXd &  filtered 
)
inline
void getInclusionIndices ( vector< bool > const &  inclusion,
vector< size_t > &  indices,
bool  get_true_indices 
)
inline

Here is the caller graph for this function:

size_t getNumTrue ( vector< bool > const &  bools)
inline

Here is the caller graph for this function:

void getThresholdInclusion ( MatrixBase< Derived > const &  values,
const double  threshold,
vector< bool > &  below_threshold 
)
inline

Here is the caller graph for this function:

void mexFunction ( int  nlhs,
mxArray *  plhs[],
int  nrhs,
const mxArray *  prhs[] 
)

Here is the call graph for this function:

void partitionMatrix ( vector< bool > const &  indices,
MatrixXd const &  M,
MatrixXd &  included,
MatrixXd &  excluded 
)
inline

Here is the call graph for this function:

Here is the caller graph for this function:

void partitionVector ( vector< bool > const &  indices,
VectorXd const &  v,
VectorXd &  included,
VectorXd &  excluded 
)
inline

Here is the call graph for this function:

Here is the caller graph for this function: