226 lines
		
	
	
		
			8.0 KiB
		
	
	
	
		
			C++
		
	
	
		
		
			
		
	
	
			226 lines
		
	
	
		
			8.0 KiB
		
	
	
	
		
			C++
		
	
	
| 
								 | 
							
								#include <gtwrap/matlab.h>
							 | 
						||
| 
								 | 
							
								#include <map>
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#include <boost/archive/text_iarchive.hpp>
							 | 
						||
| 
								 | 
							
								#include <boost/archive/text_oarchive.hpp>
							 | 
						||
| 
								 | 
							
								#include <boost/serialization/export.hpp>
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								typedef ScopedTemplate<Result> ScopedTemplateResult;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								typedef std::set<boost::shared_ptr<TemplatedConstructor>*> Collector_TemplatedConstructor;
							 | 
						||
| 
								 | 
							
								static Collector_TemplatedConstructor collector_TemplatedConstructor;
							 | 
						||
| 
								 | 
							
								typedef std::set<boost::shared_ptr<ScopedTemplateResult>*> Collector_ScopedTemplateResult;
							 | 
						||
| 
								 | 
							
								static Collector_ScopedTemplateResult collector_ScopedTemplateResult;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void _deleteAllObjects()
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								  mstream mout;
							 | 
						||
| 
								 | 
							
								  std::streambuf *outbuf = std::cout.rdbuf(&mout);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  bool anyDeleted = false;
							 | 
						||
| 
								 | 
							
								  { for(Collector_TemplatedConstructor::iterator iter = collector_TemplatedConstructor.begin();
							 | 
						||
| 
								 | 
							
								      iter != collector_TemplatedConstructor.end(); ) {
							 | 
						||
| 
								 | 
							
								    delete *iter;
							 | 
						||
| 
								 | 
							
								    collector_TemplatedConstructor.erase(iter++);
							 | 
						||
| 
								 | 
							
								    anyDeleted = true;
							 | 
						||
| 
								 | 
							
								  } }
							 | 
						||
| 
								 | 
							
								  { for(Collector_ScopedTemplateResult::iterator iter = collector_ScopedTemplateResult.begin();
							 | 
						||
| 
								 | 
							
								      iter != collector_ScopedTemplateResult.end(); ) {
							 | 
						||
| 
								 | 
							
								    delete *iter;
							 | 
						||
| 
								 | 
							
								    collector_ScopedTemplateResult.erase(iter++);
							 | 
						||
| 
								 | 
							
								    anyDeleted = true;
							 | 
						||
| 
								 | 
							
								  } }
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  if(anyDeleted)
							 | 
						||
| 
								 | 
							
								    cout <<
							 | 
						||
| 
								 | 
							
								      "WARNING:  Wrap modules with variables in the workspace have been reloaded due to\n"
							 | 
						||
| 
								 | 
							
								      "calling destructors, call 'clear all' again if you plan to now recompile a wrap\n"
							 | 
						||
| 
								 | 
							
								      "module, so that your recompiled module is used instead of the old one." << endl;
							 | 
						||
| 
								 | 
							
								  std::cout.rdbuf(outbuf);
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void _template_RTTIRegister() {
							 | 
						||
| 
								 | 
							
								  const mxArray *alreadyCreated = mexGetVariablePtr("global", "gtsam_template_rttiRegistry_created");
							 | 
						||
| 
								 | 
							
								  if(!alreadyCreated) {
							 | 
						||
| 
								 | 
							
								    std::map<std::string, std::string> types;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    mxArray *registry = mexGetVariable("global", "gtsamwrap_rttiRegistry");
							 | 
						||
| 
								 | 
							
								    if(!registry)
							 | 
						||
| 
								 | 
							
								      registry = mxCreateStructMatrix(1, 1, 0, NULL);
							 | 
						||
| 
								 | 
							
								    typedef std::pair<std::string, std::string> StringPair;
							 | 
						||
| 
								 | 
							
								    for(const StringPair& rtti_matlab: types) {
							 | 
						||
| 
								 | 
							
								      int fieldId = mxAddField(registry, rtti_matlab.first.c_str());
							 | 
						||
| 
								 | 
							
								      if(fieldId < 0) {
							 | 
						||
| 
								 | 
							
								        mexErrMsgTxt("gtsam wrap:  Error indexing RTTI types, inheritance will not work correctly");
							 | 
						||
| 
								 | 
							
								      }
							 | 
						||
| 
								 | 
							
								      mxArray *matlabName = mxCreateString(rtti_matlab.second.c_str());
							 | 
						||
| 
								 | 
							
								      mxSetFieldByNumber(registry, 0, fieldId, matlabName);
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								    if(mexPutVariable("global", "gtsamwrap_rttiRegistry", registry) != 0) {
							 | 
						||
| 
								 | 
							
								      mexErrMsgTxt("gtsam wrap:  Error indexing RTTI types, inheritance will not work correctly");
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								    mxDestroyArray(registry);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    mxArray *newAlreadyCreated = mxCreateNumericMatrix(0, 0, mxINT8_CLASS, mxREAL);
							 | 
						||
| 
								 | 
							
								    if(mexPutVariable("global", "gtsam_template_rttiRegistry_created", newAlreadyCreated) != 0) {
							 | 
						||
| 
								 | 
							
								      mexErrMsgTxt("gtsam wrap:  Error indexing RTTI types, inheritance will not work correctly");
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								    mxDestroyArray(newAlreadyCreated);
							 | 
						||
| 
								 | 
							
								  }
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void TemplatedConstructor_collectorInsertAndMakeBase_0(int nargout, mxArray *out[], int nargin, const mxArray *in[])
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								  mexAtExit(&_deleteAllObjects);
							 | 
						||
| 
								 | 
							
								  typedef boost::shared_ptr<TemplatedConstructor> Shared;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  Shared *self = *reinterpret_cast<Shared**> (mxGetData(in[0]));
							 | 
						||
| 
								 | 
							
								  collector_TemplatedConstructor.insert(self);
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void TemplatedConstructor_constructor_1(int nargout, mxArray *out[], int nargin, const mxArray *in[])
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								  mexAtExit(&_deleteAllObjects);
							 | 
						||
| 
								 | 
							
								  typedef boost::shared_ptr<TemplatedConstructor> Shared;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  Shared *self = new Shared(new TemplatedConstructor());
							 | 
						||
| 
								 | 
							
								  collector_TemplatedConstructor.insert(self);
							 | 
						||
| 
								 | 
							
								  out[0] = mxCreateNumericMatrix(1, 1, mxUINT32OR64_CLASS, mxREAL);
							 | 
						||
| 
								 | 
							
								  *reinterpret_cast<Shared**> (mxGetData(out[0])) = self;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void TemplatedConstructor_constructor_2(int nargout, mxArray *out[], int nargin, const mxArray *in[])
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								  mexAtExit(&_deleteAllObjects);
							 | 
						||
| 
								 | 
							
								  typedef boost::shared_ptr<TemplatedConstructor> Shared;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  string& arg = *unwrap_shared_ptr< string >(in[0], "ptr_string");
							 | 
						||
| 
								 | 
							
								  Shared *self = new Shared(new TemplatedConstructor(arg));
							 | 
						||
| 
								 | 
							
								  collector_TemplatedConstructor.insert(self);
							 | 
						||
| 
								 | 
							
								  out[0] = mxCreateNumericMatrix(1, 1, mxUINT32OR64_CLASS, mxREAL);
							 | 
						||
| 
								 | 
							
								  *reinterpret_cast<Shared**> (mxGetData(out[0])) = self;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void TemplatedConstructor_constructor_3(int nargout, mxArray *out[], int nargin, const mxArray *in[])
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								  mexAtExit(&_deleteAllObjects);
							 | 
						||
| 
								 | 
							
								  typedef boost::shared_ptr<TemplatedConstructor> Shared;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  int arg = unwrap< int >(in[0]);
							 | 
						||
| 
								 | 
							
								  Shared *self = new Shared(new TemplatedConstructor(arg));
							 | 
						||
| 
								 | 
							
								  collector_TemplatedConstructor.insert(self);
							 | 
						||
| 
								 | 
							
								  out[0] = mxCreateNumericMatrix(1, 1, mxUINT32OR64_CLASS, mxREAL);
							 | 
						||
| 
								 | 
							
								  *reinterpret_cast<Shared**> (mxGetData(out[0])) = self;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void TemplatedConstructor_constructor_4(int nargout, mxArray *out[], int nargin, const mxArray *in[])
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								  mexAtExit(&_deleteAllObjects);
							 | 
						||
| 
								 | 
							
								  typedef boost::shared_ptr<TemplatedConstructor> Shared;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  double arg = unwrap< double >(in[0]);
							 | 
						||
| 
								 | 
							
								  Shared *self = new Shared(new TemplatedConstructor(arg));
							 | 
						||
| 
								 | 
							
								  collector_TemplatedConstructor.insert(self);
							 | 
						||
| 
								 | 
							
								  out[0] = mxCreateNumericMatrix(1, 1, mxUINT32OR64_CLASS, mxREAL);
							 | 
						||
| 
								 | 
							
								  *reinterpret_cast<Shared**> (mxGetData(out[0])) = self;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void TemplatedConstructor_deconstructor_5(int nargout, mxArray *out[], int nargin, const mxArray *in[])
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								  typedef boost::shared_ptr<TemplatedConstructor> Shared;
							 | 
						||
| 
								 | 
							
								  checkArguments("delete_TemplatedConstructor",nargout,nargin,1);
							 | 
						||
| 
								 | 
							
								  Shared *self = *reinterpret_cast<Shared**>(mxGetData(in[0]));
							 | 
						||
| 
								 | 
							
								  Collector_TemplatedConstructor::iterator item;
							 | 
						||
| 
								 | 
							
								  item = collector_TemplatedConstructor.find(self);
							 | 
						||
| 
								 | 
							
								  if(item != collector_TemplatedConstructor.end()) {
							 | 
						||
| 
								 | 
							
								    collector_TemplatedConstructor.erase(item);
							 | 
						||
| 
								 | 
							
								  }
							 | 
						||
| 
								 | 
							
								  delete self;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void ScopedTemplateResult_collectorInsertAndMakeBase_6(int nargout, mxArray *out[], int nargin, const mxArray *in[])
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								  mexAtExit(&_deleteAllObjects);
							 | 
						||
| 
								 | 
							
								  typedef boost::shared_ptr<ScopedTemplate<Result>> Shared;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  Shared *self = *reinterpret_cast<Shared**> (mxGetData(in[0]));
							 | 
						||
| 
								 | 
							
								  collector_ScopedTemplateResult.insert(self);
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void ScopedTemplateResult_constructor_7(int nargout, mxArray *out[], int nargin, const mxArray *in[])
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								  mexAtExit(&_deleteAllObjects);
							 | 
						||
| 
								 | 
							
								  typedef boost::shared_ptr<ScopedTemplate<Result>> Shared;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  Result::Value& arg = *unwrap_shared_ptr< Result::Value >(in[0], "ptr_Result::Value");
							 | 
						||
| 
								 | 
							
								  Shared *self = new Shared(new ScopedTemplate<Result>(arg));
							 | 
						||
| 
								 | 
							
								  collector_ScopedTemplateResult.insert(self);
							 | 
						||
| 
								 | 
							
								  out[0] = mxCreateNumericMatrix(1, 1, mxUINT32OR64_CLASS, mxREAL);
							 | 
						||
| 
								 | 
							
								  *reinterpret_cast<Shared**> (mxGetData(out[0])) = self;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void ScopedTemplateResult_deconstructor_8(int nargout, mxArray *out[], int nargin, const mxArray *in[])
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								  typedef boost::shared_ptr<ScopedTemplate<Result>> Shared;
							 | 
						||
| 
								 | 
							
								  checkArguments("delete_ScopedTemplateResult",nargout,nargin,1);
							 | 
						||
| 
								 | 
							
								  Shared *self = *reinterpret_cast<Shared**>(mxGetData(in[0]));
							 | 
						||
| 
								 | 
							
								  Collector_ScopedTemplateResult::iterator item;
							 | 
						||
| 
								 | 
							
								  item = collector_ScopedTemplateResult.find(self);
							 | 
						||
| 
								 | 
							
								  if(item != collector_ScopedTemplateResult.end()) {
							 | 
						||
| 
								 | 
							
								    collector_ScopedTemplateResult.erase(item);
							 | 
						||
| 
								 | 
							
								  }
							 | 
						||
| 
								 | 
							
								  delete self;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void mexFunction(int nargout, mxArray *out[], int nargin, const mxArray *in[])
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								  mstream mout;
							 | 
						||
| 
								 | 
							
								  std::streambuf *outbuf = std::cout.rdbuf(&mout);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  _template_RTTIRegister();
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  int id = unwrap<int>(in[0]);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  try {
							 | 
						||
| 
								 | 
							
								    switch(id) {
							 | 
						||
| 
								 | 
							
								    case 0:
							 | 
						||
| 
								 | 
							
								      TemplatedConstructor_collectorInsertAndMakeBase_0(nargout, out, nargin-1, in+1);
							 | 
						||
| 
								 | 
							
								      break;
							 | 
						||
| 
								 | 
							
								    case 1:
							 | 
						||
| 
								 | 
							
								      TemplatedConstructor_constructor_1(nargout, out, nargin-1, in+1);
							 | 
						||
| 
								 | 
							
								      break;
							 | 
						||
| 
								 | 
							
								    case 2:
							 | 
						||
| 
								 | 
							
								      TemplatedConstructor_constructor_2(nargout, out, nargin-1, in+1);
							 | 
						||
| 
								 | 
							
								      break;
							 | 
						||
| 
								 | 
							
								    case 3:
							 | 
						||
| 
								 | 
							
								      TemplatedConstructor_constructor_3(nargout, out, nargin-1, in+1);
							 | 
						||
| 
								 | 
							
								      break;
							 | 
						||
| 
								 | 
							
								    case 4:
							 | 
						||
| 
								 | 
							
								      TemplatedConstructor_constructor_4(nargout, out, nargin-1, in+1);
							 | 
						||
| 
								 | 
							
								      break;
							 | 
						||
| 
								 | 
							
								    case 5:
							 | 
						||
| 
								 | 
							
								      TemplatedConstructor_deconstructor_5(nargout, out, nargin-1, in+1);
							 | 
						||
| 
								 | 
							
								      break;
							 | 
						||
| 
								 | 
							
								    case 6:
							 | 
						||
| 
								 | 
							
								      ScopedTemplateResult_collectorInsertAndMakeBase_6(nargout, out, nargin-1, in+1);
							 | 
						||
| 
								 | 
							
								      break;
							 | 
						||
| 
								 | 
							
								    case 7:
							 | 
						||
| 
								 | 
							
								      ScopedTemplateResult_constructor_7(nargout, out, nargin-1, in+1);
							 | 
						||
| 
								 | 
							
								      break;
							 | 
						||
| 
								 | 
							
								    case 8:
							 | 
						||
| 
								 | 
							
								      ScopedTemplateResult_deconstructor_8(nargout, out, nargin-1, in+1);
							 | 
						||
| 
								 | 
							
								      break;
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								  } catch(const std::exception& e) {
							 | 
						||
| 
								 | 
							
								    mexErrMsgTxt(("Exception from gtsam:\n" + std::string(e.what()) + "\n").c_str());
							 | 
						||
| 
								 | 
							
								  }
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  std::cout.rdbuf(outbuf);
							 | 
						||
| 
								 | 
							
								}
							 |