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.