Function Reference
WORK IN PROGRESS Not all functions have been added to this directory yet.
Caesar
Caesar.appendvertbigdata!
— Functionappendvertbigdata!(cloudGraph, cv, description, data)
Append big data element into current blob store and update associated global vertex information.
appendvertbigdata!(fgl, vert, description, data)
Append big data element into current blob store and update associated global vertex information.
appendvertbigdata!(fg, sym, descr, data)
Append big data element into current blob store using parent appendvertbigdata!, but here specified by symbol of variable node in the FactorGraph. Note the default data layer api definition. User must define dlapi to refetching the vertex from the data layer. localapi avoids repeated network database fetches.
Caesar.consoleaskuserfordb
— Functionconsoleaskuserfordb(; nparticles, drawdepth, clearslamindb, multisession, drawedges)
Obtain database addresses and login credientials from STDIN, as well as a few case dependent options.
Caesar.db2jld
— Functiondb2jld(cgl::CloudGraph, session::AbstractString, filename::AbstractString)
Fetch and save a FactorGraph session to a jld, using CloudGraph object and session definition.
db2jld(filename::AbstractString; addrdict::NothingUnion{Dict{AbstractString, AbstractString}}=nothing )
Fetch and save a FactorGraph session to a jld, using or asking STDIN for credentials in the addrdict field.
Caesar.executeQuery
— FunctionexecuteQuery(connection, query)
Run Neo4j Cypher queries on the cloudGraph database, and return Tuple with the unparsed (results, loadresponse). Throws an error if the query fails.
Caesar.fetchrobotdatafirstpose
— Functionfetchrobotdatafirstpose(cg::CloudGraph, session::AbstractString, robot::AbstractString, user::AbstractString)
Return dict of JSON parsed "robot_description" field as was inserted by counterpart insertrobotdatafirstpose!
function. Used for storing general robot specific data in easily accessible manner.
Caesar.fetchsubgraph!
— Functionfetchsubgraph!(fgl, cvs; numneighbors)
Fetch and insert list of CloudVertices into FactorGraph object, up to neighbor depth.
fetchsubgraph!(fgl, neoids; numneighbors)
Fetch and insert list of Neo4j IDs into FactorGraph object, up to neighbor depth.
Caesar.findExistingMSConstraints
— FunctionReturn Dict{Symbol, Int} of vertex symbol to Neo4j node ID of MULTISESSION constraints in this fgl.sessionname
.
Caesar.getAllLandmarkNeoIDs
— FunctiongetAllLandmarkNeoIDs(lm2others, slm)
Return Vector{Int} of Neo4j vertex IDs relating to symbol, as listed in lm2others.
Caesar.getBigDataElement
— FunctiongetBigDataElement(vertex, description)
Walk through vertex bigDataElements and return the last matching description.
Caesar.getExVertexNeoIDs
— FunctiongetExVertexNeoIDs(conn; label, solvable, backendset, session, robot, user, reqbackendset)
Return array of tuples with ExVertex IDs and Neo4j IDs for vertices with label in session.
Caesar.getLandmOtherSessNeoIDs
— FunctiongetLandmOtherSessNeoIDs{T <: AbstractString}(::CloudGraph, session::T="", robot::T="", user::T="", multisessions=Vector{T}())
Return dict of dict of Neo4j vertex IDs by session and landmark symbols.
Caesar.getLocalSubGraphMultisession
— FunctiongetLocalSubGraphMultisession(cg, lm2others; session, robot, user, numneighbors)
Return subgraph copy of type FactorGraph contaning values from session in lm2others, and Vector{Symbol} of primary key symbols used for graph exstraction.
Caesar.getPoseExVertexNeoIDs
— FunctiongetPoseExVertexNeoIDs(conn; solvable, backendset, session, reqbackendset)
Return array of tuples with ExVertex IDs and Neo4j IDs for all poses.
Caesar.getVertNeoIDs!
— FunctiongetVertNeoIDs!(::CloudGraph, res::Dict{Symbol, Int}; session::AbstractString="NA", robot::AbstractString="NA", user::AbstractString="NA")
Insert into and return dict res
with Neo4j IDs of ExVertex labels as stored per session in Neo4j database.
Caesar.getfirstpose
— Functiongetfirstpose(cg::CloudGraph, session::AbstractString, robot::AbstractString, user::AbstractString)
Return Tuple{Symbol, Int} of first pose symbol and Neo4j node ID.
Caesar.getnewvertdict
— Functiongetnewvertdict(conn, session::AbstractString, robot::AbstractString, user::AbstractString)
Return a dictionary with frtend and mongo_keys json string information for :NEWDATA elements in Neo4j database.
Caesar.getprpt2kde
— Functiongetprp2kde(::CloudGraph, neoids::Vector{Int}; N::Int=100)
Return PriorPoint2DensityNH with N points based on beliefs of neoids, and equal share null hypothesis between length(neoids)+1 beliefs.
Caesar.hasBigDataElement
— FunctionhasBigDataElement(vertex, description)
Return true if vertex has bigDataElements with matching description.
Caesar.insertrobotdatafirstpose!
— Functioninsertrobotdatafirstpose!(cg::CloudGraph, session::AbstractString, robot::AbstractString, user::AbstractString, robotdict::Dict)
Saves robotdict via JSON to first pose in a SESSION in the database. Used for storing general robot specific data in easily accessible manner. Can fetch later retrieve same dict with counterpart fetchrobotdatafirstpose
function.
Caesar.removeNeo4jID
— FunctionremoveNeo4jID(cg::CloudGraph, neoid=-1)
Remove node from Neo4j according to Neo4j Node ID. Big data elements that may be associated with this node are not removed.
Caesar.resetentireremotesession
— Functionresetentireremotesession(conn, session, robot, user; segment)
match (n:session) remove n.backendset, n.solvable, n.data, n.bigData, n.label, n.packedType, n.exVertexId, n.shape, n.width set n :NEWDATA return n
Caesar.rmInstMultisessionPriors!
— FunctionrmInstMultisessionPriors!(::CloudGraph; session<:AbstractString=, multisessions::Vector{<:AbstractString}= )
Caesar.standardcloudgraphsetup
— Functionstandardcloudgraphsetup(; addrdict, nparticles, drawdepth, drawedges, clearslamindb, multisession)
Connect to databases via network according to addrdict, or ask user for credentials and return active cloudGraph object, as well as addrdict.
Caesar.updatenewverts!
— FunctionConvert vertices of session in Neo4j DB with Caesar.jl's required data elements in preparation for MM-iSAMCloudSolve process.
Caesar.whosNear2D
— FunctionwhosNear2D(cg, session, robot, user; x, y, yaw, dist, angle)
Find vertices near the point specified and return dictionary of symbol to Neo4j ID pairs.
Caesar.whosNear3D
— FunctionwhosNear3D(cg, session, robot, user; x, y, z, roll, pitch, yaw, dist, angle)
Find vertices near the point specified and return dictionary of symbol to Neo4j ID pairs.
RoME
RoME.getRangeKDEMax2D
— FunctiongetRangeKDEMax2D(fgl, vsym1, vsym2)
Calculate the cartesian distance between two vertices in the graph using their symbol name, and by maximum belief point.
getRangeKDEMax2D(cgl::CloudGraph, session::AbstractString, vsym1::Symbol, vsym2::Symbol)
Calculate the cartesian distange between two vertices in the graph, by session and symbol names, and by maximum belief point.
RoME.initFactorGraph!
— FunctioninitFactorGraph!(fg; P0, init, N, lbl, solvable, firstPoseType, labels)
Initialize a factor graph object as Pose2, Pose3, or neither and returns variable and factor symbols as array.
RoME.addOdoFG!
— FunctionaddOdoFG!(fg, n, DX, cov; N, solvable, labels)
Create a new variable node and insert odometry constraint factor between which will automatically increment latest pose symbol x<k+1> for new node new node and constraint factor are returned as a tuple.
addOdoFG!(fgl, odo; N, solvable, labels)
Create a new variable node and insert odometry constraint factor between which will automatically increment latest pose symbol x<k+1> for new node new node and constraint factor are returned as a tuple.
IncrementalInference
DistributedFactorGraphs.addVariable!
— FunctionaddVariable!(dfg, lbl, softtype; N, autoinit, solvable, timestamp, dontmargin, labels, smalldata, checkduplicates, initsolvekeys)
Add a variable node lbl::Symbol
to fg::AbstractDFG
, as softtype<:InferenceVariable
.
Example
fg = initfg()
addVariable!(fg, :x0, Pose2)
DistributedFactorGraphs.addFactor!
— FunctionAdd factor with user defined type <: FunctorInferenceType to the factor graph object. Define whether the automatic initialization of variables should be performed. Use order sensitive multihypo
keyword argument to define if any variables are related to data association uncertainty.
IncrementalInference.approxCliqMarginalUp!
— FunctionapproxCliqMarginalUp!(fg_, tree_, cliq)
approxCliqMarginalUp!(fg_, tree_, cliq, childmsgs; N, dbg, iters, drawpdf, multiproc, logger)
Approximate Chapman-Kolmogorov transit integral and return separator marginals as messages to pass up the Bayes (Junction) tree, along with additional clique operation values for debugging.
Notes
onduplicate=true
by default internally uses deepcopy of factor graph and Bayes tree, and does not update the given objects. Set false to updatefgl
andtreel
during compute.
Future
- TODO: internal function chain is too long and needs to be refactored for maintainability.
IncrementalInference.approxConv
— FunctionapproxConv(dfg, fc, towards)
approxConv(dfg, fc, towards, measurement; N)
Draw samples from the approximate convolution of towards
symbol using factor fct
relative to the other variables. In addition the api
can be adjusted to recover the data from elsewhere (likely to be replaced/removed in the future).
IncrementalInference.areCliqChildrenNeedDownMsg
— FunctionareCliqChildrenNeedDownMsg(children)
Return true
if any of the children cliques have status :needdownmsg
.
IncrementalInference.areCliqVariablesAllMarginalized
— FunctionareCliqVariablesAllMarginalized(subfg, cliq)
Return true if all variables in clique are considered marginalized (and initialized).
IncrementalInference.assignTreeHistory!
— FunctionassignTreeHistory!(treel, cliqHistories)
After solving, clique histories can be inserted back into the tree for later reference. This function helps do the required assigment task.
IncrementalInference.asyncTreeInferUp!
— FunctionPerform tree based initialization of all variables not yet initialized in factor graph as non-blocking method.
Notes:
- To simplify debugging, this method does not include the usual
@ sync
around all the state machine async processes. - Extract the error stack with a
fetch
on the failed process return by this function.
Related
initInferTreeUp!
IncrementalInference.attemptTreeSimilarClique
— FunctionattemptTreeSimilarClique(othertree, seeksSimilar)
Special internal function to try return the clique data if succesfully identified in othertree::AbstractBayesTree
, based on contents of seeksSimilar::BayesTreeNodeData
.
Notes
- Used to identify and skip similar cliques (i.e. recycle computations)
IncrementalInference.blockCliqUntilChildrenHaveUpStatus
— FunctionblockCliqUntilChildrenHaveUpStatus(tree, prnt)
blockCliqUntilChildrenHaveUpStatus(tree, prnt, logger)
Block the thread until child cliques of prnt::TreeClique
have finished attempting upward initialization – i.e. have status result. Return ::Dict{Symbol}
indicating whether next action that should be taken for each child clique.
Notes:
- See status options at
getCliqStatusUp(..)
. - Can be called multiple times
Missing docstring for buildSubgraphFromLabels
. Check Documenter's build log for details.
IncrementalInference.buildTreeFromOrdering!
— FunctionbuildTreeFromOrdering!(dfg, p; drawbayesnet, maxparallel, solvable)
Build Bayes/Junction/Elimination tree from a given variable ordering.
buildTreeFromOrdering!(dfg, p; drawbayesnet, maxparallel)
Build Bayes/Junction/Elimination tree from a given variable ordering.
Missing docstring for buildCliqSubgraphDown
. Check Documenter's build log for details.
Missing docstring for buildCliqSubgraphUp
. Check Documenter's build log for details.
IncrementalInference.childCliqs
— FunctionchildCliqs(treel, cliq)
Return a vector of child cliques to cliq
.
IncrementalInference.cliqGibbs
— FunctioncliqGibbs(fg, cliq, vsym, inmsgs, N, dbg, manis)
cliqGibbs(fg, cliq, vsym, inmsgs, N, dbg, manis, logger)
Perform one step of the minibatch clique Gibbs operation for solving the Chapman-Kolmogov trasit integral – here involving separate approximate functional convolution and product operations.
IncrementalInference.cliqHistFilterTransitions
— FunctioncliqHistFilterTransitions(hist, nextfnc)
Return state machine transition steps from history such that the nextfnc::Function
.
Related:
getCliqSolveHistory, printCliqHistorySummary, filterHistAllToArray, sandboxCliqResolveStep
IncrementalInference.cliqInitSolveUpByStateMachine!
— FunctioncliqInitSolveUpByStateMachine!(dfg, tree, cliq; N, oldcliqdata, drawtree, show, incremental, limititers, upsolve, downsolve, recordhistory, delay, logger)
EXPERIMENTAL: perform upward inference using a state machine solution approach.
Notes:
- will call on values from children or parent cliques
- can be called multiple times
- Assumes all cliques in tree are being solved simultaneously and in similar manner.
- State machine rev.1 – copied from first TreeBasedInitialization.jl.
- Doesn't do partial initialized state properly yet.
Missing docstring for compareAllVariables
. Check Documenter's build log for details.
Missing docstring for compareFactorGraphs
. Check Documenter's build log for details.
Missing docstring for compareSimilarFactors
. Check Documenter's build log for details.
Missing docstring for compareSimilarVariables
. Check Documenter's build log for details.
Missing docstring for compareSubsetFactorGraph
. Check Documenter's build log for details.
Missing docstring for compareVariable
. Check Documenter's build log for details.
IncrementalInference.csmAnimate
— FunctioncsmAnimate(fg, tree, cliqsyms; frames, rmfirst)
Animate multiple clique state machines on the same graphviz visualization. Renders according to linear time for all provided histories.
Example:
using Caesar
# build a factor graph
fg = initfg()
# addVariable!(...)
# addFactor!(...)
# ...
fsy = getTreeAllFrontalSyms(fg, tree) # for later use
# perform inference to find the factor graph marginal posterior estimates
tree, smt, hist = solveTree!(fg, recordcliqs=fsy)
# generate frames in standard location /tmp/caesar/csmCompound/
# requires: sudo apt-get install graphviz
csmAnimate(fg, tree, fsy, frames=500)
# to render and show from default location (might require)
# sudo apt-get install ffmpeg vlc
# .ogv [Totem Ubuntu default]
Base.rm("/tmp/caesar/csmCompound/out.ogv")
run(`ffmpeg -r 10 -i /tmp/caesar/csmCompound/csm_%d.png -c:v libtheora -vf fps=25 -pix_fmt yuv420p -vf "scale=trunc(iw/2)*2:trunc(ih/2)*2" -q 10 /tmp/caesar/csmCompound/out.ogv`)
run(`totem /tmp/caesar/csmCompound/out.ogv`)
# h.264 [VLC not default]
Base.rm("/tmp/caesar/csmCompound/out.mp4")
run(`ffmpeg -r 10 -i /tmp/caesar/csmCompound/csm_%d.png -c:v libx264 -vf fps=25 -pix_fmt yuv420p -vf "scale=trunc(iw/2)*2:trunc(ih/2)*2" /tmp/caesar/csmCompound/out.mp4`)
run(`vlc /tmp/caesar/csmCompound/out.mp4`)
IncrementalInference.cycleInitByVarOrder!
— FunctioncycleInitByVarOrder!(subfg, varorder; logger)
Cycle through var order and initialize variables as possible in subfg::AbstractDFG
. Return true if something was updated.
Notes:
- assumed
subfg
is a subgraph containing only the factors that can be used.- including the required up or down messages
- intended for both up and down initialization operations.
Dev Notes
- Should monitor updates based on the number of inferred & solvable dimensions
Missing docstring for decodefg
. Check Documenter's build log for details.
Missing docstring for deleteFactor!
. Check Documenter's build log for details.
Missing docstring for deleteVariable!
. Check Documenter's build log for details.
IncrementalInference.doautoinit!
— Functiondoautoinit!(dfg, xi; singles, N, logger)
EXPERIMENTAL: initialize target variable xi
based on connected factors in the factor graph fgl
. Possibly called from addFactor!
, or doCliqAutoInitUp!
(?).
Notes:
- Special carve out for multihypo cases, see issue 427.
Development Notes:
Target factor is first (singletons) or second (dim 2 pairwise) variable vertex in
xi
.
- TODO use DFG properly with local operations and DB update at end.
- TODO get faster version of
isInitialized
for database version. - TODO: Persist this back if we want to here.
IncrementalInference.doCliqUpSolve!
— FunctiondoCliqUpSolve!(subfg, tree, cliq; multiproc, logger)
Update subfg<:AbstractDFG
according to internal computations for a full upsolve.
IncrementalInference.downGibbsCliqueDensity
— FunctiondownGibbsCliqueDensity(fg, cliq, dwnMsgs)
downGibbsCliqueDensity(fg, cliq, dwnMsgs, N)
downGibbsCliqueDensity(fg, cliq, dwnMsgs, N, MCMCIter)
downGibbsCliqueDensity(fg, cliq, dwnMsgs, N, MCMCIter, dbg)
downGibbsCliqueDensity(fg, cliq, dwnMsgs, N, MCMCIter, dbg, usemsgpriors)
downGibbsCliqueDensity(fg, cliq, dwnMsgs, N, MCMCIter, dbg, usemsgpriors, logger)
Perform Chapman-Kolmogorov transit integral approximation for cliq
in downward pass direction.
Notes
- Only update frontal variables of the clique.
Missing docstring for downMsgPassingRecursive
. Check Documenter's build log for details.
IncrementalInference.drawCliqSubgraphUpMocking
— FunctiondrawCliqSubgraphUpMocking(fgl, treel, frontalSym; show, filepath, engine, viewerapp)
Construct (new) subgraph and draw the subgraph associated with clique frontalSym::Symbol
.
Notes
- See
drawGraphCliq
/writeGraphPdf
for details on keyword options.
Related
drawGraphCliq, spyCliqMat, drawTree, buildCliqSubgraphUp, buildSubgraphFromLabels!
Missing docstring for dwnMsg
. Check Documenter's build log for details.
IncrementalInference.fifoFreeze!
— FunctionfifoFreeze!(dfg)
Freeze nodes that are older than the quasi fixed-lag length defined by fg.qfl
, according to fg.fifo
ordering.
Future:
- Allow different freezing strategies beyond fifo.
IncrementalInference.filterHistAllToArray
— FunctionfilterHistAllToArray(tree, frontals, nextfnc)
Return state machine transition steps from all cliq histories with transition nextfnc::Function
.
Related:
getCliqSolveHistory, printCliqHistorySummary, cliqHistFilterTransitions, sandboxCliqResolveStep
IncrementalInference.findRelatedFromPotential
— FunctionfindRelatedFromPotential(dfg, fct, varid, N)
findRelatedFromPotential(dfg, fct, varid, N, dbg)
Compute proposal belief on vertid
through fct
representing some constraint in factor graph. Always full dimension variable node – partial constraints will only influence subset of variable dimensions. The remaining dimensions will keep pre-existing variable values.
Notes
- fulldim is true when "rank-deficient" – TODO swap to false (or even float)
IncrementalInference.fmcmc!
— Functionfmcmc!(fgl, cliq, fmsgs, lbls, N, MCMCIter)
fmcmc!(fgl, cliq, fmsgs, lbls, N, MCMCIter, dbg)
fmcmc!(fgl, cliq, fmsgs, lbls, N, MCMCIter, dbg, logger)
fmcmc!(fgl, cliq, fmsgs, lbls, N, MCMCIter, dbg, logger, multithreaded)
Iterate successive approximations of clique marginal beliefs by means of the stipulated proposal convolutions and products of the functional objects for tree clique cliq
.
IncrementalInference.getCliq
— FunctiongetCliq(bt, frt)
Return the TreeClique node object that represents a clique in the Bayes (Junction) tree, as defined by one of the frontal variables frt<:AbstractString
.
Notes
- Frontal variables only occur once in a clique per tree, therefore is a unique identifier.
Related:
getCliq, getTreeAllFrontalSyms
IncrementalInference.getCliqAllVarIds
— FunctiongetCliqAllVarIds(cliq)
Get all cliq
variable ids::Symbol
.
Related
getCliqVarIdsAll, getCliqAllFactIds, getCliqVarsWithFrontalNeighbors
IncrementalInference.getCliqAllVarSyms
— FunctionGet all cliq
variable labels as ::Symbol
.
IncrementalInference.getCliqAssocMat
— FunctiongetCliqAssocMat(cliq)
Return boolean matrix of factor by variable (row by column) associations within clique, corresponds to order presented by getCliqFactorIds
and getCliqAllVarIds
.
IncrementalInference.getCliqChildMsgsUp
— FunctiongetCliqChildMsgsUp(fg_, treel, cliq, ?)
Get and return upward belief messages as stored in child cliques from treel::AbstractBayesTree
.
Notes
- Use last parameter to select the return format.
- Pull model #674
DevNotes
- Consolidate two versions getCliqChildMsgsUp
IncrementalInference.getCliqDepth
— FunctiongetCliqDepth(tree, cliq)
Return depth in tree as ::Int
, with root as depth=0.
Related
getCliq
IncrementalInference.getCliqDownMsgsAfterDownSolve
— FunctiongetCliqDownMsgsAfterDownSolve(subdfg, cliq)
Return dictionary of down messages consisting of all frontal and separator beliefs of this clique.
Notes:
- Fetches numerical results from
subdfg
as dictated incliq
. - return LikelihoodMessage
IncrementalInference.getCliqFrontalVarIds
— FunctiongetCliqFrontalVarIds(cliqdata)
Get the frontal variable IDs ::Int
for a given clique in a Bayes (Junction) tree.
IncrementalInference.getCliqVarInitOrderUp
— FunctiongetCliqVarInitOrderUp(cliq)
Return the most likely ordering for initializing factor (assuming up solve sequence).
Notes:
- sorts id for increasing number of connected factors.
IncrementalInference.getCliqMat
— FunctiongetCliqMat(cliq; showmsg)
Return boolean matrix of factor variable associations for a clique, optionally including (showmsg::Bool=true
) the upward message singletons. Variable order corresponds to getCliqAllVarIds
.
Missing docstring for getCliqOrderUpSolve
. Check Documenter's build log for details.
IncrementalInference.getCliqParentMsgDown
— FunctiongetCliqParentMsgDown(treel, cliq)
Get the latest down message from the parent node (without calculating anything).
Notes
- Different from down initialization messages that do calculate new values – see
prepCliqInitMsgsDown!
. - Basically converts function
getDwnMsgs
fromDict{Symbol,BallTreeDensity}
toDict{Symbol,Vector{BallTreeDensity}}
.
IncrementalInference.getCliqSeparatorVarIds
— FunctiongetCliqSeparatorVarIds(cliqdata)
Get cliq
separator (a.k.a. conditional) variable ids::Symbol
.
IncrementalInference.getCliqSiblings
— FunctiongetCliqSiblings(treel, cliq)
getCliqSiblings(treel, cliq, inclusive)
Return a vector of all siblings to a clique, which defaults to not inclusive
the calling cliq
.
IncrementalInference.getCliqSolveHistory
— FunctiongetCliqSolveHistory(cliq)
Return clique state machine history from tree
if it was solved with recordcliqs
.
Notes
- Cliques are identified by front variable
::Symbol
which are always unique across the cliques.
IncrementalInference.getCliqVarIdsPriors
— FunctiongetCliqVarIdsPriors(cliq)
getCliqVarIdsPriors(cliq, allids)
getCliqVarIdsPriors(cliq, allids, partials)
Get variable ids::Int
with prior factors associated with this cliq
.
Notes:
- does not include any singleton messages from upward or downward message passing.
Missing docstring for getCliqVars
. Check Documenter's build log for details.
IncrementalInference.getCliqVarSingletons
— FunctiongetCliqVarSingletons(cliq)
getCliqVarSingletons(cliq, allids)
getCliqVarSingletons(cliq, allids, partials)
Get cliq
variable IDs with singleton factors – i.e. both in clique priors and up messages.
IncrementalInference.getCurrentWorkspaceFactors
— FunctiongetCurrentWorkspaceFactors()
Return all factors currently registered in the workspace.
IncrementalInference.getCurrentWorkspaceVariables
— FunctiongetCurrentWorkspaceVariables()
Return all variables currently registered in the workspace.
IncrementalInference.getKDE
— FunctiongetBelief(vnd)
Get KernelDensityEstimate kde estimate stored in variable node.
IncrementalInference.getLogPath
— FunctiongetLogPath(opt)
Get the folder location where debug and solver information is recorded for a particular factor graph.
IncrementalInference.getManifolds
— FunctiongetManifolds(vd)
Return the manifolds on which variable sym::Symbol
is defined.
IncrementalInference.getParent
— FunctiongetParent(treel, afrontal)
Return cliq
's parent clique.
IncrementalInference.getTreeAllFrontalSyms
— FunctionReturn one symbol (a frontal variable) from each clique in the ::BayesTree
.
Notes
- Frontal variables only occur once in a clique per tree, therefore is a unique identifier.
Related:
whichCliq, printCliqHistorySummary
Missing docstring for getTreeCliqSolveOrderUp
. Check Documenter's build log for details.
IncrementalInference.getTreeCliqsSolverHistories
— FunctionReturn dict of all histories in a Bayes Tree.
IncrementalInference.getVal
— FunctiongetVal(v; solveKey)
Convenience function to get point values sampled i.i.d from marginal of lbl
variable in the current factor graph.
getVal(vA)
getVal(vA, solveKey)
Fetch the variable marginal sample points without the KDE bandwidth parameter. Use getVertKDE to retrieve the full KDE object.
IncrementalInference.getVariableDim
— FunctiongetVariableDim(vard)
Return the number of dimensions this variable vertex var
contains.
Related
getVariableInferredDim, getVariableInferredDimFraction
IncrementalInference.getVariableInferredDim
— FunctiongetVariableInferredDim(vard)
getVariableInferredDim(vard, saturate)
Return the number of projected dimensions into a variable during inference.
Notes
saturate
clamps return value to no greater than variable dimension
Related
getVariableDim, getVariableInferredDimFraction, getVariableInferredDim, getVariableDim
Missing docstring for getVertKDE
. Check Documenter's build log for details.
IncrementalInference.getUpMsgs
— FunctiongetUpMsgs(csmc)
Return the last up message stored in cliq
of Bayes (Junction) tree.
IncrementalInference.getDwnMsgs
— FunctiongetDwnMsgs(csmc)
Return the last down message stored in cliq
of Bayes (Junction) tree.
IncrementalInference.hasCliq
— FunctionhasCliq(bt, frt)
Return boolean on whether the frontal variable frt::Symbol
exists somewhere in the ::BayesTree
.
Missing docstring for hasOrphans
. Check Documenter's build log for details.
IncrementalInference.initfg
— Functioninitfg()
initfg(dfg; sessionname, robotname, username, cloudgraph)
Initialize an empty in-memory DistributedFactorGraph ::DistributedFactorGraph
object.
IncrementalInference.initInferTreeUp!
— FunctionPerform tree based initialization of all variables not yet initialized in factor graph.
Related
asyncTreeInferUp!
IncrementalInference.isCliqMarginalizedFromVars
— FunctionisCliqMarginalizedFromVars(subfg, cliq)
Return ::Bool
on whether all variables in this cliq
are marginalzed.
Missing docstring for isCliqReadyInferenceUp
. Check Documenter's build log for details.
DistributedFactorGraphs.isInitialized
— FunctionisInitialized(vert)
Returns state of vertex data .initialized
flag.
Notes:
- used by Bayes tree clique logic.
- similar method in DFG
IncrementalInference.isMarginalized
— FunctionisMarginalized(vert)
Return ::Bool
on whether this variable has been marginalized.
IncrementalInference.isTreeSolved
— FunctionisTreeSolved(treel; skipinitialized)
Return true or false depending on whether the tree has been fully initialized/solved/marginalized.
IncrementalInference.isPartial
— FunctionisPartial(fcf)
Return ::Bool
on whether factor is a partial constraint.
Missing docstring for isVariable
. Check Documenter's build log for details.
IncrementalInference.localProduct
— FunctionUsing factor graph object dfg
, project belief through connected factors (convolution with conditional) to variable sym
followed by a approximate functional product.
Return: product belief, full proposals, partial dimension proposals, labels
Missing docstring for ls
. Check Documenter's build log for details.
Missing docstring for lsf
. Check Documenter's build log for details.
Missing docstring for lsfPriors
. Check Documenter's build log for details.
Missing docstring for lsRear
. Check Documenter's build log for details.
IncrementalInference.makeCsmMovie
— FunctionmakeCsmMovie(fg, tree)
makeCsmMovie(fg, tree, cliqs; assignhist, show, filename, frames)
Convenience function to assign and make video of CSM state machine for cliqs
.
Notes
- Probably several teething issues still (lower priority).
- Use
assignhist
if solver params async was true, or errored.
Related
csmAnimate, printCliqHistorySummary
Missing docstring for manualinit!
. Check Documenter's build log for details.
IncrementalInference.parentCliq
— FunctionparentCliq(treel, cliq)
Return cliq
's parent clique.
IncrementalInference.packFromLocalPotentials!
— FunctionpackFromLocalPotentials!(dfg, dens, wfac, cliq, vsym, N)
packFromLocalPotentials!(dfg, dens, wfac, cliq, vsym, N, dbg)
Add all potentials associated with this clique and vertid to dens.
RoME.predictVariableByFactor
— FunctionpredictVariableByFactor(dfg, targetsym, fct, prevars)
Method to compare current and predicted estimate on a variable, developed for testing a new factor before adding to the factor graph.
Notes
fct
does not have to be in the factor graph – likely used to test beforehand.- function is useful for detecting if
multihypo
should be used. approxConv
will project the full belief estimate through some factor but must already be in factor graph.
Example
# fg already exists containing :x7 and :l3
pp = Pose2Point2BearingRange(Normal(0,0.1),Normal(10,1.0))
# possible new measurement from :x7 to :l3
curr, pred = predictVariableByFactor(fg, :l3, pp, [:x7; :l3])
# example of naive user defined test on fit score
fitscore = minkld(curr, pred)
# `multihypo` can be used as option between existing or new variables
Related
approxConv
IncrementalInference.prepBatchTree!
— FunctionprepBatchTree!(dfg; variableOrder, variableConstraints, ordering, drawpdf, show, filepath, viewerapp, imgs, drawbayesnet, maxparallel)
Build Bayes/Junction/Elimination tree.
Notes
- Default to free qr factorization for variable elimination order.
IncrementalInference.prepCliqInitMsgsDown!
— FunctionprepCliqInitMsgsDown!(fgl, tree, prnt, cliq; logger, dbgnew)
Initialization downward message passing is different from regular inference since it is possible that none of the child cliq variables have been initialized.
Notes
- init msgs from child upward passes are individually stored in this
cliq
. - fresh product of overlapping beliefs are calculated on each function call.
- Assumed that
prnt
of siblings
Dev Notes
- This should be the initialization cycle of parent, build up bit by bit...
IncrementalInference.printCliqHistorySummary
— FunctionprintCliqHistorySummary(fid, hist)
Print a short summary of state machine history for a clique solve.
Related:
getTreeAllFrontalSyms, getCliqSolveHistory, animateCliqStateMachines
Missing docstring for printgraphmax
. Check Documenter's build log for details.
IncrementalInference.productpartials!
— Functionproductpartials!(pGM, dummy, partials, manis)
Multiply different dimensions from partial constraints individually.
IncrementalInference.prodmultiplefullpartials
— FunctionMultiply various full and partial dimension constraints.
IncrementalInference.prodmultipleonefullpartials
— Functionprodmultipleonefullpartials(dens, partials, Ndims, N, manis)
Multiply a single full and several partial dimension constraints.
IncrementalInference.resetBuildTreeFromOrder!
— FunctionresetBuildTreeFromOrder!(fgl, p)
Reset factor graph and build a new tree from the provided variable ordering p
.
IncrementalInference.resetCliqSolve!
— FunctionReset the state of all variables in a clique to not initialized.
Notes
- resets numberical values to zeros.
Dev Notes
- TODO not all kde manifolds will initialize to zero.
IncrementalInference.resetData!
— FunctionresetData!(vdata)
Partial reset of basic data fields in ::VariableNodeData
of ::FunctionNode
structures.
IncrementalInference.resetTreeCliquesForUpSolve!
— FunctionresetTreeCliquesForUpSolve!(treel)
Reset the Bayes (Junction) tree so that a new upsolve can be performed.
Notes
- Will change previous clique status from
:downsolved
to:initialized
only. - Sets the color of tree clique to
lightgreen
.
IncrementalInference.resetVariable!
— FunctionresetVariable!(varid; solveKey)
Reset the solve state of a variable to uninitialized/unsolved state.
IncrementalInference.sandboxCliqResolveStep
— FunctionsandboxCliqResolveStep(tree, frontal, step)
Repeat a solver state machine step without changing history or primary values.
printCliqSummary, printCliqHistorySummary, getCliqSolveHistory, cliqHistFilterTransitions
Missing docstring for savejld
. Check Documenter's build log for details.
IncrementalInference.setCliqAsMarginalized!
— FunctionsetCliqAsMarginalized!(cliq, status)
Set the marginalized status of a clique.
IncrementalInference.setCliqStatus!
— FunctionsetCliqStatus!(cliq, status)
Set up initialization or solve status of this cliq
.
IncrementalInference.setDwnMsg!
— FunctionsetDwnMsg!(csmc, msgs)
Set the downward passing message for Bayes (Junction) tree clique cliql
.
IncrementalInference.setfreeze!
— Functionsetfreeze!(dfg, sym)
Set variable(s) sym
of factor graph to be marginalized – i.e. not be updated by inference computation.
IncrementalInference.setTreeCliquesMarginalized!
— FunctionSet all Bayes (Junction) tree cliques that have all marginalized and initialized variables.
IncrementalInference.setUpMsg!
— FunctionsetUpMsg!(csmc, cliqid, msgs)
Set the upward passing message for Bayes (Junction) tree clique cliql
.
Dev Notes
- TODO setUpMsg! should also set inferred dimension
IncrementalInference.setValKDE!
— FunctionsetValKDE!(vd, pts, bws)
setValKDE!(vd, pts, bws, setinit)
setValKDE!(vd, pts, bws, setinit, inferdim)
Set the point centers and bandwidth parameters of a variable node, also set isInitialized=true
if setinit::Bool=true
(as per default).
Notes
initialized
is used for initial solve of factor graph where variables are not yet initialized.inferdim
is used to identify if the initialized was only partial.
IncrementalInference.setVariableInitialized!
— FunctionsetVariableInitialized!(varid, status)
Set variable initialized status.
IncrementalInference.setVariableInferDim!
— FunctionsetVariableInferDim!(varid, val)
Set method for the inferred dimension value in a variable.
Missing docstring for showVariable
. Check Documenter's build log for details.
IncrementalInference.solveCliq!
— FunctionsolveCliq!(dfgl, tree, cliqid; recordcliq, async)
Perform inference over one clique in the Bayes tree according to opt::SolverParams
.
Example
tree = wipeBuildNewTree!(fg)
smt, hist = solveCliq!(fg, tree, :x1 [,cliqHistories=hist] )
Related
solveTree!, wipeBuildNewTree!
IncrementalInference.solveCliqWithStateMachine!
— FunctionsolveCliqWithStateMachine!(dfg, tree, frontal; iters, downsolve, recordhistory, verbose, nextfnc, prevcsmc)
Standalone state machine solution for a single clique.
Related:
initInferTreeUp!
IncrementalInference.solveTree!
— FunctionsolveTree!(dfgl)
solveTree!(dfgl, oldtree; storeOld, delaycliqs, recordcliqs, skipcliqids, maxparallel, variableOrder, variableConstraints)
Perform inference over the Bayes tree according to opt::SolverParams
.
Notes
- Variety of options, including fixed-lag solving – see
getSolverParams(fg)
for details. - Latest result always stored in
solvekey=:default
. - Experimental
storeOld::Bool=true
will duplicate the current result as supersolve:default_k
.- Based on
solvable==1
assumption.
- Based on
Example
# without [or with] compute recycling
tree, smt, hist = solveTree!(fg [,tree])
Related
solveCliq!, wipeBuildNewTree!
IncrementalInference.transferUpdateSubGraph!
— FunctiontransferUpdateSubGraph!(dest, src)
transferUpdateSubGraph!(dest, src, syms)
transferUpdateSubGraph!(dest, src, syms, logger; updatePPE, solveKey)
Transfer contents of src::AbstractDFG
variables syms::Vector{Symbol}
to dest::AbstractDFG
. Notes
- Reads,
dest
:=src
, for allsyms
IncrementalInference.treeProductDwn
— FunctiontreeProductDwn(fg, tree, cliq, sym; N, dbg)
Calculate a fresh–-single step–-approximation to the variable sym
in clique cliq
as though during the downward message passing. The full inference algorithm may repeatedly calculate successive apprimxations to the variable based on the structure of variables, factors, and incoming messages to this clique. Which clique to be used is defined by frontal variable symbols (cliq
in this case) – see whichCliq(...)
for more details. The sym
symbol indicates which symbol of this clique to be calculated. Note that the sym
variable must appear in the clique where cliq
is a frontal variable.
IncrementalInference.treeProductUp
— FunctiontreeProductUp(fg, tree, cliq, sym; N, dbg)
Calculate a fresh (single step) approximation to the variable sym
in clique cliq
as though during the upward message passing. The full inference algorithm may repeatedly calculate successive apprimxations to the variables based on the structure of the clique, factors, and incoming messages. Which clique to be used is defined by frontal variable symbols (cliq
in this case) – see whichCliq(...)
for more details. The sym
symbol indicates which symbol of this clique to be calculated. Note that the sym
variable must appear in the clique where cliq
is a frontal variable.
IncrementalInference.unfreezeVariablesAll!
— FunctionunfreezeVariablesAll!(fgl)
Free all variables from marginalization.
Related
dontMarginalizeVariablesAll!
IncrementalInference.dontMarginalizeVariablesAll!
— FunctiondontMarginalizeVariablesAll!(fgl)
Free all variables from marginalization.
IncrementalInference.updateFGBT!
— FunctionupdateFGBT!(fg, bt, cliqID, drt; dbg, fillcolor, logger)
Update cliq cliqID
in Bayes (Juction) tree bt
according to contents of ddt
– intended use is to update main clique after a downward belief propagation computation has been completed per clique.
updateFGBT!(fg, cliq, urt; dbg, fillcolor, logger)
Update cliq cliqID
in Bayes (Juction) tree bt
according to contents of urt
– intended use is to update main clique after a upward belief propagation computation has been completed per clique.
IncrementalInference.updateTreeCliquesAsMarginalizedFromVars!
— FunctionupdateTreeCliquesAsMarginalizedFromVars!(fgl, tree)
Run through entire tree and set cliques as marginalized if all clique variables are marginalized.
Notes:
- TODO can be made fully parallel, consider converting for use with
@threads
for
.
IncrementalInference.upGibbsCliqueDensity
— FunctionupGibbsCliqueDensity(inp)
upGibbsCliqueDensity(inp, N)
upGibbsCliqueDensity(inp, N, dbg)
upGibbsCliqueDensity(inp, N, dbg, iters)
upGibbsCliqueDensity(inp, N, dbg, iters, logger)
Perform computations required for the upward message passing during belief propation on the Bayes (Junction) tree. This function is usually called as via remote_call for multiprocess dispatch.
Example
inp = ExploreTreeType(fg,tree,cliq,parent,childmsgs)
urt = upGibbsCliqueDensity(inp)
fg
factor graph,tree
Bayes tree,cliq
which cliq to perform the computation on,parent
the parent clique to where the upward message will be sent,childmsgs
is for any incoming messages from child cliques.
Missing docstring for upMsg
. Check Documenter's build log for details.
IncrementalInference.wipeBuildNewTree!
— FunctionBuild a completely new Bayes (Junction) tree, after first wiping clean all temporary state in fg from a possibly pre-existing tree.
Related:
buildTreeFromOrdering!
IncrementalInference.writeGraphPdf
— FunctionwriteGraphPdf(fgl; viewerapp, filepath, engine, show)
writeGraphPdf deprecated, use drawGraph instead
IncrementalInference.resetVariableAllInitializations!
— FunctionresetVariableAllInitializations!(fgl)
Reset initialization flag on all variables in ::AbstractDFG
.
Notes
- Numerical values remain, but inference will overwrite since init flags are now
false
.