Add C++ version of IKoptions. Will create the mex function and test cases