|
Drake
|
#include <mex.h>#include <matrix.h>#include <math.h>#include "drake/util/drakeMexUtil.h"#include "LinearMath/btTransform.h"#include "BulletCollision/CollisionShapes/btSphereShape.h"#include "BulletCollision/CollisionShapes/btBoxShape.h"#include "BulletCollision/CollisionShapes/btConvexHullShape.h"#include "BulletCollision/NarrowPhaseCollision/btGjkPairDetector.h"#include "BulletCollision/NarrowPhaseCollision/btPointCollector.h"#include "BulletCollision/NarrowPhaseCollision/btVoronoiSimplexSolver.h"#include "BulletCollision/NarrowPhaseCollision/btConvexPenetrationDepthSolver.h"#include "BulletCollision/NarrowPhaseCollision/btGjkEpaPenetrationDepthSolver.h"#include "LinearMath/btTransformUtil.h"
Functions | |
| double | ptToPolyBullet (double *vertsPr, size_t nRows, size_t nCols) |
| double * | shiftAndTransform (double *verts, double *vertsT, const mxArray *x, mxArray *x0, int k, mxArray *cSk, size_t nRows, size_t nCols) |
| bool | isCollisionFree (int funnelIdx, const mxArray *x, const mxArray *funnelLibrary, const mxArray *obstacles, mwSize numObs, double *min_dist) |
| void | mexFunction (int nlhs, mxArray *plhs[], int nrhs, const mxArray *prhs[]) |
Variables | |
| static btVoronoiSimplexSolver | sGjkSimplexSolver |
| static btGjkEpaPenetrationDepthSolver | epaSolver |
| static const double | g_radius = 1.0 |
| static btSphereShape * | g_point = new btSphereShape(g_radius) |
| bool isCollisionFree | ( | int | funnelIdx, |
| const mxArray * | x, | ||
| const mxArray * | funnelLibrary, | ||
| const mxArray * | obstacles, | ||
| mwSize | numObs, | ||
| double * | min_dist | ||
| ) |


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


| double* shiftAndTransform | ( | double * | verts, |
| double * | vertsT, | ||
| const mxArray * | x, | ||
| mxArray * | x0, | ||
| int | k, | ||
| mxArray * | cSk, | ||
| size_t | nRows, | ||
| size_t | nCols | ||
| ) |


|
static |
|
static |
|
static |
|
static |