octomap wrapper works for simple example
first pass at typing in octree writer system
RigidBodyDepthCamera -> RigidBodyDepthSensor
initial lcmgl code is in (but not tested)
octree lcmgl works (but is certainly not optimized)
Plumbing for active_collision_options.collision_groups
Add test for active collision options

Test collisions for only specific bodies/groups
Fix handling of default constructed `Body` objects.
Handle the active_collision_options.group properly

Now only elements in the groups listed will be checked for collisions.
Pass collision group names from MATLAB to mex
Fix constructModelmex for collision elem. w/o grps
Add robotnum arg to removeCollisionGroups[Except]

The default is 1:numel(model.name). This allows for backwards compatibility
with code that expects the terrain to be preserved.
Add LCMGLClient convenience function.

This runs checkDependency('lcmgl'), then creates and returns a BotLCMGLClient.
Add getCMMdA

This is a `geval`-compatible version of `getCMM`. I think it should end up
being called `getCMM`, but I don't want to go through and change all the
current uses of `getCMM` to `getCMMAdot` in the DRC codebase right now.
add the SimpleDynamicsFullKinematicsPlanner class
Modify some constraint classes for cached kinsol

In order to get the size of the gradients correct, we have to pass q as well as
kinsol into the constraint eval method. I've modified the generate constraint
method in QuasiStaticConstraint and SingleTimeKinamaticConstraint to take (and
ignore) that extra argument.
Add KinematicPlanner
Minor fix to documentation
Decrease major iterations limit in SDFKP
1.construct a base class SimpleDynamicsFullKinematicsPlanner
2.construct a derived class ComDynamicsFUllKinematicsPlanner which enforces com acceleration and centroidal angular mometnum to match with the external forces
3.make changes on matGradMultMat for speed