42 {
44 return true;
45 }
46 switch (commandNode->commandType()) {
48 AddNode* c = static_cast<AddNode*>(commandNode);
49 return _slam->
addNode(c->tag(), c->id(), c->dimension(), c->values());
50 }
52 AddEdge* c = static_cast<AddEdge*>(commandNode);
53 return _slam->
addEdge(c->tag(), c->id(), c->dimension(), c->id1(),
54 c->id2(), c->values(), c->information());
55 }
57
59 }
61 QueryState* c = static_cast<QueryState*>(commandNode);
63 }
65 FixNode* c = static_cast<FixNode*>(commandNode);
67 }
68 }
69 cerr << "SlamContextInterface::process: Unknown command type" << endl;
70 return false;
71}
virtual bool solveState()=0
virtual bool fixNode(const std::vector< int > &nodes)=0
virtual bool addEdge(const std::string &tag, int id, int dimension, int v1, int v2, const std::vector< double > &measurement, const std::vector< double > &information)=0
virtual bool queryState(const std::vector< int > &nodes)=0
virtual bool addNode(const std::string &tag, int id, int dimension, const std::vector< double > &values)=0