Created successful CMake package for MATLAB

@chachi and I designed a CMake package for the MATLAB interface. This will make it infinitely more usable. Also added some namespaces, since the move to URDF messed some stuff up. 
You should append to this rather than setting it.