654 lines
26 KiB
C++
654 lines
26 KiB
C++
/* ----------------------------------------------------------------------------
|
|
|
|
* GTSAM Copyright 2010, Georgia Tech Research Corporation,
|
|
* Atlanta, Georgia 30332-0415
|
|
* All Rights Reserved
|
|
* Authors: Frank Dellaert, et al. (see THANKS for the full author list)
|
|
|
|
* See LICENSE for the license information
|
|
|
|
* -------------------------------------------------------------------------- */
|
|
|
|
/**
|
|
* @file Module.ccp
|
|
* @author Frank Dellaert
|
|
* @author Alex Cunningham
|
|
* @author Andrew Melim
|
|
* @author Richard Roberts
|
|
**/
|
|
|
|
#include "Module.h"
|
|
#include "FileWriter.h"
|
|
#include "TypeAttributesTable.h"
|
|
#include "utilities.h"
|
|
|
|
//#define BOOST_SPIRIT_DEBUG
|
|
#include "spirit_actors.h"
|
|
|
|
#include <boost/spirit/include/classic_confix.hpp>
|
|
#include <boost/spirit/include/classic_clear_actor.hpp>
|
|
#include <boost/spirit/include/classic_insert_at_actor.hpp>
|
|
#ifdef __GNUC__
|
|
#pragma GCC diagnostic push
|
|
#pragma GCC diagnostic ignored "-Wunused-variable"
|
|
#endif
|
|
#include <boost/lambda/bind.hpp>
|
|
#include <boost/lambda/lambda.hpp>
|
|
#ifdef __GNUC__
|
|
#pragma GCC diagnostic pop
|
|
#endif
|
|
#include <boost/lambda/construct.hpp>
|
|
#include <boost/foreach.hpp>
|
|
#include <boost/filesystem.hpp>
|
|
#include <boost/lexical_cast.hpp>
|
|
|
|
#include <iostream>
|
|
#include <algorithm>
|
|
|
|
using namespace std;
|
|
using namespace wrap;
|
|
using namespace BOOST_SPIRIT_CLASSIC_NS;
|
|
namespace bl = boost::lambda;
|
|
namespace fs = boost::filesystem;
|
|
|
|
typedef rule<BOOST_SPIRIT_CLASSIC_NS::phrase_scanner_t> Rule;
|
|
|
|
/* ************************************************************************* */
|
|
// We parse an interface file into a Module object.
|
|
// The grammar is defined using the boost/spirit combinatorial parser.
|
|
// For example, str_p("const") parses the string "const", and the >>
|
|
// operator creates a sequence parser. The grammar below, composed of rules
|
|
// and with start rule [class_p], doubles as the specs for our interface files.
|
|
/* ************************************************************************* */
|
|
|
|
/* ************************************************************************* */
|
|
// If a number of template arguments were given, generate a number of expanded
|
|
// class names, e.g., PriorFactor -> PriorFactorPose2, and add those classes
|
|
static void handle_possible_template(vector<Class>& classes, const Class& cls,
|
|
const vector<Qualified>& instantiations) {
|
|
if (cls.templateArgs.empty() || instantiations.empty()) {
|
|
classes.push_back(cls);
|
|
} else {
|
|
if (cls.templateArgs.size() != 1)
|
|
throw std::runtime_error(
|
|
"In-line template instantiations only handle a single template argument");
|
|
vector<Class> classInstantiations = //
|
|
cls.expandTemplate(cls.templateArgs.front(), instantiations);
|
|
BOOST_FOREACH(const Class& c, classInstantiations)
|
|
classes.push_back(c);
|
|
}
|
|
}
|
|
|
|
/* ************************************************************************* */
|
|
Module::Module(const std::string& moduleName, bool enable_verbose)
|
|
: name(moduleName), verbose(enable_verbose)
|
|
{
|
|
}
|
|
|
|
/* ************************************************************************* */
|
|
Module::Module(const string& interfacePath,
|
|
const string& moduleName, bool enable_verbose)
|
|
: name(moduleName), verbose(enable_verbose)
|
|
{
|
|
// read interface file
|
|
string interfaceFile = interfacePath + "/" + moduleName + ".h";
|
|
string contents = file_contents(interfaceFile);
|
|
|
|
// execute parsing
|
|
parseMarkup(contents);
|
|
}
|
|
|
|
/* ************************************************************************* */
|
|
void Module::parseMarkup(const std::string& data) {
|
|
// The parse imperatively :-( updates variables gradually during parse
|
|
// The one with postfix 0 are used to reset the variables after parse.
|
|
vector<string> namespaces; // current namespace tag
|
|
|
|
//----------------------------------------------------------------------------
|
|
// Grammar with actions that build the Class object. Actions are
|
|
// defined within the square brackets [] and are executed whenever a
|
|
// rule is successfully parsed. Define BOOST_SPIRIT_DEBUG to debug.
|
|
// The grammar is allows a very restricted C++ header
|
|
// lexeme_d turns off white space skipping
|
|
// http://www.boost.org/doc/libs/1_37_0/libs/spirit/classic/doc/directives.html
|
|
// ----------------------------------------------------------------------------
|
|
|
|
Rule comments_p = comment_p("/*", "*/") | comment_p("//", eol_p);
|
|
|
|
Rule basisType_p =
|
|
(str_p("string") | "bool" | "size_t" | "int" | "double" | "char" | "unsigned char");
|
|
|
|
Rule keywords_p =
|
|
(str_p("const") | "static" | "namespace" | "void" | basisType_p);
|
|
|
|
Rule eigenType_p =
|
|
(str_p("Vector") | "Matrix");
|
|
|
|
//Rule for STL Containers (class names are lowercase)
|
|
Rule stlType_p = (str_p("vector") | "list");
|
|
|
|
Rule className_p = (lexeme_d[upper_p >> *(alnum_p | '_')] - eigenType_p - keywords_p) | stlType_p;
|
|
|
|
Rule namespace_name_p = lexeme_d[lower_p >> *(alnum_p | '_')] - keywords_p;
|
|
|
|
Argument arg0, arg;
|
|
Rule namespace_arg_p = namespace_name_p
|
|
[push_back_a(arg.type.namespaces)] >> str_p("::");
|
|
|
|
Rule argEigenType_p =
|
|
eigenType_p[assign_a(arg.type.name)];
|
|
|
|
Rule eigenRef_p =
|
|
!str_p("const") [assign_a(arg.is_const,true)] >>
|
|
eigenType_p [assign_a(arg.type.name)] >>
|
|
ch_p('&') [assign_a(arg.is_ref,true)];
|
|
|
|
Rule classArg_p =
|
|
!str_p("const") [assign_a(arg.is_const,true)] >>
|
|
*namespace_arg_p >>
|
|
className_p[assign_a(arg.type.name)] >>
|
|
!ch_p('&')[assign_a(arg.is_ref,true)];
|
|
|
|
Rule name_p = lexeme_d[alpha_p >> *(alnum_p | '_')];
|
|
|
|
// TODO, do we really need cls here? Non-local
|
|
Class cls0(verbose),cls(verbose);
|
|
Rule classParent_p =
|
|
*(namespace_name_p[push_back_a(cls.qualifiedParent.namespaces)] >> str_p("::")) >>
|
|
className_p[assign_a(cls.qualifiedParent.name)];
|
|
|
|
// parse "gtsam::Pose2" and add to templateArgValues
|
|
Qualified templateArgValue;
|
|
vector<Qualified> templateArgValues;
|
|
Rule templateArgValue_p =
|
|
(*(namespace_name_p[push_back_a(templateArgValue.namespaces)] >> str_p("::")) >>
|
|
className_p[assign_a(templateArgValue.name)])
|
|
[push_back_a(templateArgValues, templateArgValue)]
|
|
[clear_a(templateArgValue)];
|
|
|
|
// template<CALIBRATION = {gtsam::Cal3DS2}>
|
|
string templateArgName;
|
|
Rule templateArgValues_p =
|
|
(str_p("template") >>
|
|
'<' >> name_p[assign_a(templateArgName)] >> '=' >>
|
|
'{' >> !(templateArgValue_p >> *(',' >> templateArgValue_p)) >> '}' >>
|
|
'>');
|
|
|
|
// parse "gtsam::Pose2" and add to singleInstantiation.typeList
|
|
TemplateInstantiationTypedef singleInstantiation;
|
|
Rule templateSingleInstantiationArg_p =
|
|
(*(namespace_name_p[push_back_a(templateArgValue.namespaces)] >> str_p("::")) >>
|
|
className_p[assign_a(templateArgValue.name)])
|
|
[push_back_a(singleInstantiation.typeList, templateArgValue)]
|
|
[clear_a(templateArgValue)];
|
|
|
|
// typedef gtsam::RangeFactor<gtsam::Pose2, gtsam::Point2> RangeFactorPosePoint2;
|
|
TemplateInstantiationTypedef singleInstantiation0;
|
|
Rule templateSingleInstantiation_p =
|
|
(str_p("typedef") >>
|
|
*(namespace_name_p[push_back_a(singleInstantiation.class_.namespaces)] >> str_p("::")) >>
|
|
className_p[assign_a(singleInstantiation.class_.name)] >>
|
|
'<' >> templateSingleInstantiationArg_p >> *(',' >> templateSingleInstantiationArg_p) >>
|
|
'>' >>
|
|
className_p[assign_a(singleInstantiation.name)] >>
|
|
';')
|
|
[assign_a(singleInstantiation.namespaces, namespaces)]
|
|
[push_back_a(templateInstantiationTypedefs, singleInstantiation)]
|
|
[assign_a(singleInstantiation, singleInstantiation0)];
|
|
|
|
// template<POSE, POINT>
|
|
Rule templateList_p =
|
|
(str_p("template") >>
|
|
'<' >> name_p[push_back_a(cls.templateArgs)] >> *(',' >> name_p[push_back_a(cls.templateArgs)]) >>
|
|
'>');
|
|
|
|
// NOTE: allows for pointers to all types
|
|
ArgumentList args;
|
|
Rule argument_p =
|
|
((basisType_p[assign_a(arg.type.name)] | argEigenType_p | eigenRef_p | classArg_p)
|
|
>> !ch_p('*')[assign_a(arg.is_ptr,true)]
|
|
>> name_p[assign_a(arg.name)])
|
|
[push_back_a(args, arg)]
|
|
[assign_a(arg,arg0)];
|
|
|
|
Rule argumentList_p = !argument_p >> * (',' >> argument_p);
|
|
|
|
// parse class constructor
|
|
Constructor constructor0(verbose), constructor(verbose);
|
|
Rule constructor_p =
|
|
(className_p >> '(' >> argumentList_p >> ')' >> ';' >> !comments_p)
|
|
[bl::bind(&Constructor::addOverload, bl::var(constructor), bl::var(args))]
|
|
[clear_a(args)];
|
|
|
|
vector<string> namespaces_return; /// namespace for current return type
|
|
Rule namespace_ret_p = namespace_name_p[push_back_a(namespaces_return)] >> str_p("::");
|
|
|
|
// HACK: use const values instead of using enums themselves - somehow this doesn't result in values getting assigned to gibberish
|
|
static const ReturnType::return_category RETURN_EIGEN = ReturnType::EIGEN;
|
|
static const ReturnType::return_category RETURN_BASIS = ReturnType::BASIS;
|
|
static const ReturnType::return_category RETURN_CLASS = ReturnType::CLASS;
|
|
static const ReturnType::return_category RETURN_VOID = ReturnType::VOID;
|
|
|
|
ReturnType retType0, retType;
|
|
Rule returnType_p =
|
|
(basisType_p[assign_a(retType.name)][assign_a(retType.category, RETURN_BASIS)]) |
|
|
((*namespace_ret_p)[assign_a(retType.namespaces, namespaces_return)][clear_a(namespaces_return)]
|
|
>> (className_p[assign_a(retType.name)][assign_a(retType.category, RETURN_CLASS)]) >>
|
|
!ch_p('*')[assign_a(retType.isPtr,true)]) |
|
|
(eigenType_p[assign_a(retType.name)][assign_a(retType.category, RETURN_EIGEN)]);
|
|
|
|
ReturnValue retVal0, retVal;
|
|
Rule returnType1_p = returnType_p[assign_a(retVal.type1,retType)][assign_a(retType,retType0)];
|
|
Rule returnType2_p = returnType_p[assign_a(retVal.type2,retType)][assign_a(retType,retType0)];
|
|
|
|
Rule pair_p =
|
|
(str_p("pair") >> '<' >> returnType1_p >> ',' >> returnType2_p >> '>')
|
|
[assign_a(retVal.isPair,true)];
|
|
|
|
Rule void_p = str_p("void")[assign_a(retVal.type1.name)][assign_a(retVal.type1.category, RETURN_VOID)];
|
|
|
|
Rule returnValue_p = void_p | pair_p | returnType1_p;
|
|
|
|
Rule methodName_p = lexeme_d[(upper_p | lower_p) >> *(alnum_p | '_')];
|
|
|
|
// gtsam::Values retract(const gtsam::VectorValues& delta) const;
|
|
string methodName;
|
|
bool isConst, isConst0 = false;
|
|
Rule method_p =
|
|
!templateArgValues_p >>
|
|
(returnValue_p >> methodName_p[assign_a(methodName)] >>
|
|
'(' >> argumentList_p >> ')' >>
|
|
!str_p("const")[assign_a(isConst,true)] >> ';' >> *comments_p)
|
|
[bl::bind(&Class::addMethod, bl::var(cls), verbose, bl::var(isConst),
|
|
bl::var(methodName), bl::var(args), bl::var(retVal),
|
|
bl::var(templateArgName), bl::var(templateArgValues))]
|
|
[assign_a(retVal,retVal0)]
|
|
[clear_a(args)]
|
|
[clear_a(templateArgValues)]
|
|
[assign_a(isConst,isConst0)];
|
|
|
|
Rule staticMethodName_p = lexeme_d[(upper_p | lower_p) >> *(alnum_p | '_')];
|
|
|
|
Rule static_method_p =
|
|
(str_p("static") >> returnValue_p >> staticMethodName_p[assign_a(methodName)] >>
|
|
'(' >> argumentList_p >> ')' >> ';' >> *comments_p)
|
|
[bl::bind(&StaticMethod::addOverload,
|
|
bl::var(cls.static_methods)[bl::var(methodName)],
|
|
verbose, bl::var(methodName), bl::var(args), bl::var(retVal), Qualified())]
|
|
[assign_a(retVal,retVal0)]
|
|
[clear_a(args)];
|
|
|
|
Rule functions_p = constructor_p | method_p | static_method_p;
|
|
|
|
// parse a full class
|
|
vector<Qualified> templateInstantiations;
|
|
Rule class_p =
|
|
eps_p[assign_a(cls,cls0)]
|
|
>> (!(templateArgValues_p
|
|
[push_back_a(cls.templateArgs, templateArgName)]
|
|
[assign_a(templateInstantiations,templateArgValues)]
|
|
[clear_a(templateArgValues)]
|
|
| templateList_p)
|
|
>> !(str_p("virtual")[assign_a(cls.isVirtual, true)])
|
|
>> str_p("class")
|
|
>> className_p[assign_a(cls.name)]
|
|
>> ((':' >> classParent_p >> '{') | '{')
|
|
>> *(functions_p | comments_p)
|
|
>> str_p("};"))
|
|
[assign_a(constructor.name, cls.name)]
|
|
[assign_a(cls.constructor, constructor)]
|
|
[assign_a(cls.namespaces, namespaces)]
|
|
[assign_a(cls.deconstructor.name,cls.name)]
|
|
[bl::bind(&handle_possible_template, bl::var(classes), bl::var(cls),
|
|
bl::var(templateInstantiations))]
|
|
[clear_a(templateInstantiations)]
|
|
[assign_a(constructor, constructor0)]
|
|
[assign_a(cls,cls0)];
|
|
|
|
// parse a global function
|
|
Qualified globalFunction;
|
|
Rule global_function_p =
|
|
(returnValue_p >> staticMethodName_p[assign_a(globalFunction.name)] >>
|
|
'(' >> argumentList_p >> ')' >> ';' >> *comments_p)
|
|
[assign_a(globalFunction.namespaces,namespaces)]
|
|
[bl::bind(&GlobalFunction::addOverload,
|
|
bl::var(global_functions)[bl::var(globalFunction.name)],
|
|
verbose, bl::var(globalFunction), bl::var(args), bl::var(retVal), Qualified())]
|
|
[assign_a(retVal,retVal0)]
|
|
[clear_a(globalFunction)]
|
|
[clear_a(args)];
|
|
|
|
Rule include_p = str_p("#include") >> ch_p('<') >> (*(anychar_p - '>'))[push_back_a(includes)] >> ch_p('>');
|
|
|
|
#ifdef __clang__
|
|
#pragma clang diagnostic push
|
|
#pragma clang diagnostic ignored "-Wuninitialized"
|
|
#endif
|
|
|
|
Rule namespace_def_p =
|
|
(str_p("namespace")
|
|
>> namespace_name_p[push_back_a(namespaces)]
|
|
>> ch_p('{')
|
|
>> *(include_p | class_p | templateSingleInstantiation_p | global_function_p | namespace_def_p | comments_p)
|
|
>> ch_p('}'))
|
|
[pop_a(namespaces)];
|
|
|
|
#ifdef __clang__
|
|
#pragma clang diagnostic pop
|
|
#endif
|
|
|
|
// parse forward declaration
|
|
ForwardDeclaration fwDec0, fwDec;
|
|
Rule forward_declaration_p =
|
|
!(str_p("virtual")[assign_a(fwDec.isVirtual, true)])
|
|
>> str_p("class")
|
|
>> (*(namespace_name_p >> str_p("::")) >> className_p)[assign_a(fwDec.name)]
|
|
>> ch_p(';')
|
|
[push_back_a(forward_declarations, fwDec)]
|
|
[assign_a(fwDec, fwDec0)];
|
|
|
|
Rule module_content_p = comments_p | include_p | class_p | templateSingleInstantiation_p | forward_declaration_p | global_function_p | namespace_def_p;
|
|
|
|
Rule module_p = *module_content_p >> !end_p;
|
|
|
|
//----------------------------------------------------------------------------
|
|
// for debugging, define BOOST_SPIRIT_DEBUG
|
|
# ifdef BOOST_SPIRIT_DEBUG
|
|
BOOST_SPIRIT_DEBUG_NODE(className_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(classPtr_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(classRef_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(basisType_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(name_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(argument_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(argumentList_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(constructor_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(returnType1_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(returnType2_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(pair_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(void_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(returnValue_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(methodName_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(method_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(class_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(namespace_def_p);
|
|
BOOST_SPIRIT_DEBUG_NODE(module_p);
|
|
# endif
|
|
//----------------------------------------------------------------------------
|
|
|
|
// and parse contents
|
|
parse_info<const char*> info = parse(data.c_str(), module_p, space_p);
|
|
if(!info.full) {
|
|
printf("parsing stopped at \n%.20s\n",info.stop);
|
|
cout << "Stopped near:\n"
|
|
"class '" << cls.name << "'\n"
|
|
"method '" << methodName << "'\n"
|
|
"argument '" << arg.name << "'" << endl;
|
|
throw ParseFailed((int)info.length);
|
|
}
|
|
|
|
// Post-process classes for serialization markers
|
|
BOOST_FOREACH(Class& cls, classes)
|
|
cls.erase_serialization();
|
|
|
|
// Explicitly add methods to the classes from parents so it shows in documentation
|
|
BOOST_FOREACH(Class& cls, classes)
|
|
cls.appendInheritedMethods(cls, classes);
|
|
}
|
|
|
|
/* ************************************************************************* */
|
|
void Module::generateIncludes(FileWriter& file) const {
|
|
|
|
// collect includes
|
|
vector<string> all_includes(includes);
|
|
|
|
// sort and remove duplicates
|
|
sort(all_includes.begin(), all_includes.end());
|
|
vector<string>::const_iterator last_include = unique(all_includes.begin(), all_includes.end());
|
|
vector<string>::const_iterator it = all_includes.begin();
|
|
// add includes to file
|
|
for (; it != last_include; ++it)
|
|
file.oss << "#include <" << *it << ">" << endl;
|
|
file.oss << "\n";
|
|
}
|
|
|
|
|
|
/* ************************************************************************* */
|
|
void Module::matlab_code(const string& toolboxPath, const string& headerPath) const {
|
|
|
|
fs::create_directories(toolboxPath);
|
|
|
|
// Expand templates - This is done first so that template instantiations are
|
|
// counted in the list of valid types, have their attributes and dependencies
|
|
// checked, etc.
|
|
vector<Class> expandedClasses = ExpandTypedefInstantiations(classes, templateInstantiationTypedefs);
|
|
|
|
// Dependency check list
|
|
vector<string> validTypes = GenerateValidTypes(expandedClasses, forward_declarations);
|
|
|
|
// Check that all classes have been defined somewhere
|
|
verifyArguments<GlobalFunction>(validTypes, global_functions);
|
|
verifyReturnTypes<GlobalFunction>(validTypes, global_functions);
|
|
|
|
bool hasSerialiable = false;
|
|
BOOST_FOREACH(const Class& cls, expandedClasses)
|
|
cls.verifyAll(validTypes,hasSerialiable);
|
|
|
|
// Create type attributes table and check validity
|
|
TypeAttributesTable typeAttributes;
|
|
typeAttributes.addClasses(expandedClasses);
|
|
typeAttributes.addForwardDeclarations(forward_declarations);
|
|
typeAttributes.checkValidity(expandedClasses);
|
|
|
|
// create the unified .cpp switch file
|
|
const string wrapperName = name + "_wrapper";
|
|
string wrapperFileName = toolboxPath + "/" + wrapperName + ".cpp";
|
|
FileWriter wrapperFile(wrapperFileName, verbose, "//");
|
|
wrapperFile.oss << "#include <wrap/matlab.h>\n";
|
|
wrapperFile.oss << "#include <map>\n";
|
|
wrapperFile.oss << "#include <boost/foreach.hpp>\n";
|
|
wrapperFile.oss << "\n";
|
|
|
|
// Include boost.serialization archive headers before other class headers
|
|
if (hasSerialiable) {
|
|
wrapperFile.oss << "#include <boost/serialization/export.hpp>\n";
|
|
wrapperFile.oss << "#include <boost/archive/text_iarchive.hpp>\n";
|
|
wrapperFile.oss << "#include <boost/archive/text_oarchive.hpp>\n\n";
|
|
}
|
|
|
|
// Generate includes while avoiding redundant includes
|
|
generateIncludes(wrapperFile);
|
|
|
|
// create typedef classes - we put this at the top of the wrap file so that collectors and method arguments can use these typedefs
|
|
BOOST_FOREACH(const Class& cls, expandedClasses) {
|
|
if(!cls.typedefName.empty())
|
|
wrapperFile.oss << cls.getTypedef() << "\n";
|
|
}
|
|
wrapperFile.oss << "\n";
|
|
|
|
// Generate boost.serialization export flags (needs typedefs from above)
|
|
if (hasSerialiable) {
|
|
BOOST_FOREACH(const Class& cls, expandedClasses) {
|
|
if(cls.isSerializable)
|
|
wrapperFile.oss << cls.getSerializationExport() << "\n";
|
|
}
|
|
wrapperFile.oss << "\n";
|
|
}
|
|
|
|
// Generate collectors and cleanup function to be called from mexAtExit
|
|
WriteCollectorsAndCleanupFcn(wrapperFile, name, expandedClasses);
|
|
|
|
// generate RTTI registry (for returning derived-most types)
|
|
WriteRTTIRegistry(wrapperFile, name, expandedClasses);
|
|
|
|
vector<string> functionNames; // Function names stored by index for switch
|
|
|
|
// create proxy class and wrapper code
|
|
BOOST_FOREACH(const Class& cls, expandedClasses) {
|
|
cls.matlab_proxy(toolboxPath, wrapperName, typeAttributes, wrapperFile, functionNames);
|
|
}
|
|
|
|
// create matlab files and wrapper code for global functions
|
|
BOOST_FOREACH(const GlobalFunctions::value_type& p, global_functions) {
|
|
p.second.matlab_proxy(toolboxPath, wrapperName, typeAttributes, wrapperFile, functionNames);
|
|
}
|
|
|
|
// finish wrapper file
|
|
wrapperFile.oss << "\n";
|
|
finish_wrapper(wrapperFile, functionNames);
|
|
|
|
wrapperFile.emit(true);
|
|
}
|
|
|
|
/* ************************************************************************* */
|
|
void Module::finish_wrapper(FileWriter& file, const std::vector<std::string>& functionNames) const {
|
|
file.oss << "void mexFunction(int nargout, mxArray *out[], int nargin, const mxArray *in[])\n";
|
|
file.oss << "{\n";
|
|
file.oss << " mstream mout;\n"; // Send stdout to MATLAB console
|
|
file.oss << " std::streambuf *outbuf = std::cout.rdbuf(&mout);\n\n";
|
|
file.oss << " _" << name << "_RTTIRegister();\n\n";
|
|
file.oss << " int id = unwrap<int>(in[0]);\n\n";
|
|
file.oss << " try {\n";
|
|
file.oss << " switch(id) {\n";
|
|
for(size_t id = 0; id < functionNames.size(); ++id) {
|
|
file.oss << " case " << id << ":\n";
|
|
file.oss << " " << functionNames[id] << "(nargout, out, nargin-1, in+1);\n";
|
|
file.oss << " break;\n";
|
|
}
|
|
file.oss << " }\n";
|
|
file.oss << " } catch(const std::exception& e) {\n";
|
|
file.oss << " mexErrMsgTxt((\"Exception from gtsam:\\n\" + std::string(e.what()) + \"\\n\").c_str());\n";
|
|
file.oss << " }\n";
|
|
file.oss << "\n";
|
|
file.oss << " std::cout.rdbuf(outbuf);\n"; // Restore cout
|
|
file.oss << "}\n";
|
|
}
|
|
|
|
/* ************************************************************************* */
|
|
vector<Class> Module::ExpandTypedefInstantiations(const vector<Class>& classes, const vector<TemplateInstantiationTypedef> instantiations) {
|
|
|
|
vector<Class> expandedClasses = classes;
|
|
|
|
BOOST_FOREACH(const TemplateInstantiationTypedef& inst, instantiations) {
|
|
// Add the new class to the list
|
|
expandedClasses.push_back(inst.findAndExpand(classes));
|
|
}
|
|
|
|
// Remove all template classes
|
|
for(size_t i = 0; i < expandedClasses.size(); ++i)
|
|
if(!expandedClasses[size_t(i)].templateArgs.empty()) {
|
|
expandedClasses.erase(expandedClasses.begin() + size_t(i));
|
|
-- i;
|
|
}
|
|
|
|
return expandedClasses;
|
|
}
|
|
|
|
/* ************************************************************************* */
|
|
vector<string> Module::GenerateValidTypes(const vector<Class>& classes, const vector<ForwardDeclaration> forwardDeclarations) {
|
|
vector<string> validTypes;
|
|
BOOST_FOREACH(const ForwardDeclaration& fwDec, forwardDeclarations) {
|
|
validTypes.push_back(fwDec.name);
|
|
}
|
|
validTypes.push_back("void");
|
|
validTypes.push_back("string");
|
|
validTypes.push_back("int");
|
|
validTypes.push_back("bool");
|
|
validTypes.push_back("char");
|
|
validTypes.push_back("unsigned char");
|
|
validTypes.push_back("size_t");
|
|
validTypes.push_back("double");
|
|
validTypes.push_back("Vector");
|
|
validTypes.push_back("Matrix");
|
|
//Create a list of parsed classes for dependency checking
|
|
BOOST_FOREACH(const Class& cls, classes) {
|
|
validTypes.push_back(cls.qualifiedName("::"));
|
|
}
|
|
|
|
return validTypes;
|
|
}
|
|
|
|
/* ************************************************************************* */
|
|
void Module::WriteCollectorsAndCleanupFcn(FileWriter& wrapperFile, const std::string& moduleName, const std::vector<Class>& classes) {
|
|
// Generate all collectors
|
|
BOOST_FOREACH(const Class& cls, classes) {
|
|
const string matlabUniqueName = cls.qualifiedName(),
|
|
cppName = cls.qualifiedName("::");
|
|
wrapperFile.oss << "typedef std::set<boost::shared_ptr<" << cppName << ">*> "
|
|
<< "Collector_" << matlabUniqueName << ";\n";
|
|
wrapperFile.oss << "static Collector_" << matlabUniqueName <<
|
|
" collector_" << matlabUniqueName << ";\n";
|
|
}
|
|
|
|
// generate mexAtExit cleanup function
|
|
wrapperFile.oss <<
|
|
"\nvoid _deleteAllObjects()\n"
|
|
"{\n"
|
|
" mstream mout;\n" // Send stdout to MATLAB console
|
|
" std::streambuf *outbuf = std::cout.rdbuf(&mout);\n\n"
|
|
" bool anyDeleted = false;\n";
|
|
BOOST_FOREACH(const Class& cls, classes) {
|
|
const string matlabUniqueName = cls.qualifiedName();
|
|
const string cppName = cls.qualifiedName("::");
|
|
const string collectorType = "Collector_" + matlabUniqueName;
|
|
const string collectorName = "collector_" + matlabUniqueName;
|
|
// The extra curly-braces around the for loops work around a limitation in MSVC (existing
|
|
// since 2005!) preventing more than 248 blocks.
|
|
wrapperFile.oss <<
|
|
" { for(" << collectorType << "::iterator iter = " << collectorName << ".begin();\n"
|
|
" iter != " << collectorName << ".end(); ) {\n"
|
|
" delete *iter;\n"
|
|
" " << collectorName << ".erase(iter++);\n"
|
|
" anyDeleted = true;\n"
|
|
" } }\n";
|
|
}
|
|
wrapperFile.oss <<
|
|
" if(anyDeleted)\n"
|
|
" cout <<\n"
|
|
" \"WARNING: Wrap modules with variables in the workspace have been reloaded due to\\n\"\n"
|
|
" \"calling destructors, call 'clear all' again if you plan to now recompile a wrap\\n\"\n"
|
|
" \"module, so that your recompiled module is used instead of the old one.\" << endl;\n"
|
|
" std::cout.rdbuf(outbuf);\n" // Restore cout
|
|
"}\n\n";
|
|
}
|
|
|
|
/* ************************************************************************* */
|
|
void Module::WriteRTTIRegistry(FileWriter& wrapperFile, const std::string& moduleName, const std::vector<Class>& classes) {
|
|
wrapperFile.oss <<
|
|
"void _" << moduleName << "_RTTIRegister() {\n"
|
|
" const mxArray *alreadyCreated = mexGetVariablePtr(\"global\", \"gtsam_" + moduleName + "_rttiRegistry_created\");\n"
|
|
" if(!alreadyCreated) {\n"
|
|
" std::map<std::string, std::string> types;\n";
|
|
BOOST_FOREACH(const Class& cls, classes) {
|
|
if(cls.isVirtual)
|
|
wrapperFile.oss <<
|
|
" types.insert(std::make_pair(typeid(" << cls.qualifiedName("::") << ").name(), \"" << cls.qualifiedName(".") << "\"));\n";
|
|
}
|
|
wrapperFile.oss << "\n";
|
|
|
|
wrapperFile.oss <<
|
|
" mxArray *registry = mexGetVariable(\"global\", \"gtsamwrap_rttiRegistry\");\n"
|
|
" if(!registry)\n"
|
|
" registry = mxCreateStructMatrix(1, 1, 0, NULL);\n"
|
|
" typedef std::pair<std::string, std::string> StringPair;\n"
|
|
" BOOST_FOREACH(const StringPair& rtti_matlab, types) {\n"
|
|
" int fieldId = mxAddField(registry, rtti_matlab.first.c_str());\n"
|
|
" if(fieldId < 0)\n"
|
|
" mexErrMsgTxt(\"gtsam wrap: Error indexing RTTI types, inheritance will not work correctly\");\n"
|
|
" mxArray *matlabName = mxCreateString(rtti_matlab.second.c_str());\n"
|
|
" mxSetFieldByNumber(registry, 0, fieldId, matlabName);\n"
|
|
" }\n"
|
|
" if(mexPutVariable(\"global\", \"gtsamwrap_rttiRegistry\", registry) != 0)\n"
|
|
" mexErrMsgTxt(\"gtsam wrap: Error indexing RTTI types, inheritance will not work correctly\");\n"
|
|
" mxDestroyArray(registry);\n"
|
|
" \n"
|
|
" mxArray *newAlreadyCreated = mxCreateNumericMatrix(0, 0, mxINT8_CLASS, mxREAL);\n"
|
|
" if(mexPutVariable(\"global\", \"gtsam_" + moduleName + "_rttiRegistry_created\", newAlreadyCreated) != 0)\n"
|
|
" mexErrMsgTxt(\"gtsam wrap: Error indexing RTTI types, inheritance will not work correctly\");\n"
|
|
" mxDestroyArray(newAlreadyCreated);\n"
|
|
" }\n"
|
|
"}\n"
|
|
"\n";
|
|
}
|
|
|
|
/* ************************************************************************* */
|