change add_mex to add_executable for ik c++ test
fix the problem of seg fault by changing add_mex to add_library in drakeQuatUtil. Also add robotnum in URDFRigidBodyManipulator