mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-03 10:00:23 +08:00
* added doc and tests for util2d.h * updated cmake-ros ci * Added util3d.h doc and tests * util3d_transforms.h: Added doc and tests * util3d_filtering.h: started doc and test * util3d_filtering.h: more tests and doc * Added more doc/tests * finished util3d_filtering doc and tests * added test for util2d::depthBleedingFiltering * Added util3d_registration tests * Added util3d_features.h doc/tests * added doc/tests for util3d_correspondences.h * added doc/gtest for util3d_mapping.h (missing hpp functions) * finished testing util3d_mapping.hpp * Added util3d_motion_estimation.h tests (2D->3D done) * finished util3d_motion_estimation.h tests * minimal util3d_surface.h * Added Transform and VisualWord tests * Added doc for CameraModel and StereoCameraModel * Added more logs in ros ci * Passing tests on fical * improved all devcontainer * added devcontainer kilted, fixed source setup.bash, removed ldconfig in ros-cmake workflow * cleanup * source ros * Added utilite tests * Added testing to appveyor, github actions cancellable on re-commit on same branch * appveyor testing without all targets * appveyor: specifying ALL_BUILD target * Fixed Util2dTest.NMSImageBoundsRespected test * Fixing PCL Indices error on old pcl * Added VWDictionary tests and doc. Fixed LSH not working (fix from https://github.com/flann-lib/flann/pull/472 * fixing some appveyor CI errors, added test to check dictionary serialization against all type * Added StereoDense, StereoBM and StereoSGBM doc and tests * Added Stereo tests * Added CameraModel and StereoCameraModel tests * Added doc and test for Statistics * Added doc/tests for Signature * Added doc/test for SensorEvent, added doc for SensorCaptureInfo * Added doc to SensorData * Added SensorData tests * Added SensorCapture and SensorCaptureThread doc and tests * fixed sensordata test * updated SSC test and doc * Added doc and tests for BayesFilter class * Enabled testing on mac, updated windows testing like on linux * added test_link * fixed unresolved on windows * fixed ThreadHandle error on macos ci * Added GPS and GeodeticCoords tests * Added tests for compression * Added Odometry tests (base class only) * Added DBDriver tests * Added coverage report * uniformized test names * fixing concurancy and coverage ci * dont built tools, examples and app for coverage build * fixed report tool rebuilt without qt compilation error * updated coverage option * updated coverage config * added doc CI job * fixing windows and mac ci errors * Added DBDriverSqlite3 tests * Added IMU tests * Added Graph tests * fixing flaky macos test * Added IMUThread and IMUFilter tests * Added Landmarks tests * Added LASWriter tests * fixing seed flaky test * fixing flaky macos timing tests * Added LocalGrid tests * Added LocalGridMaker tests * fixing ci errors * Added GlobalMap tests * Added doc for EnvSensor * Added Features2D tests * Added Registration tests * Added RegistrationVis tests * Added doc for Rtabmap and Memory classes * Added Memory and Rtabmap tests * making some tests less flaky * lcov 1.14 support * updated compatible tool arguments * Added integration tests (RGB-D, Stereo, Lidar2d, Lidar3d) * More octomap checks * Refactored how/when python interpretor is created to simplify library usage * Added python tests * fixed some flaky tests * suppressed some third party related warnings * fixed ceres tests * more flaky fixes * Fixing tests without libpointmatcher * Added RANSAC rejection filter to PCL ICP * fixing multi platform flakiness * Added test to detect regression * Fixing windows pcl link error * fixed some macos flakiness * bigger 2D2D registration error on opencv 4.6.0 * flakiness * fixing flaky tests on windows and mac * flaky thread test on slow mac VM * windows slow test * fixing more ci erros * fxing temp dir on windows * Added Optimizer tests and discovered some bugs (fixed) * fixing flaky tests in mac and windows * Added Optimizer doc * Added GTSAM BA, updated Ceres to use g2o ba parameters. Renamed g2o's ba related parameters to Optimizer group and used by both gtsam and ceres. * fixing build without gtsam * fixing home dir * fixing python ci isssues * Added multicam ba tests * Added Ceres multicam BA support * Aligned BundleAdjustment parameters with Optimizer/Strategy to avoid confusion in the code * Added BA integration test * Added robust graph optimization integration test * Added loop3it test * Added stereo20Hz test * Added smartfactor gtsam * Fixed bugged check and warn if python didn't return any descriptors * Fixing gtsam version build issues * fixing tilt on windows ci * loosing ceres integration test for ci * mac ci flakiness * updating missing param in gui * updating test bound for mac * added appearance-based tests, set min gftt quality to quality level * testing more stuff * improving features2d tests * ci flakiness * fixing flaky ci * ci fixes * flaky fixes * Added RegistrationIcp tests * Added icp integration test with real-worl corridor like env * intermediate nodes * fixing enum * Updated test to catch #1714 * Fixed 2d corridor failing on pcl * flaky pnp test * flaky brisk test * Set rtabmap_integration test as long * updating loop closure test * flaky ci tests * TEsting roundtrip g2o/toro save/load * loosing test bound * fixed cuda capable checks * flaky tests * Debugging test hanging * more debugging stuff * updating limit * windows: disabled cuda on ci to avoid incompatible driver issue. Fixing a bad test mem allocation * trying fixing cuda hanging issue * fixing ci flakyness * flaky tests * Updated BOW flaky tests by checking min precision/recall instead of recall@100precision. Fixed signature test * CameraModel::load() test initRectificationMap param * test dbdriver load dictionary idsOnly * Memory: test keepLinkedInDb param * added dummyDictionary tests * test intermediate nodes count * Added MarkerDetector tests * reverted breaking change of UMutex and USemaphore * Features2d: fixed compiltion warnings with clang about override * clang warnings * fixing test build with pcl 1.8 * g2o and gtsam build errors on android * opencv5 test fixes * disabled testing for ios and android builds * normalized endline characters for easier diff * added LF CRLF rule * bump 0.23.10. fixing doc version * Publish rtabmap website doc from ci * fixing MSCVC build error * macos icp flaky test * fixing ceres macos test bound * ficing more flaky tests * fixing opencv5 related test errors. Also fixed an actual bug in ENU_WGS84ToGeocentric_WGS84() * added comment about mrpt change * removed rosdoc2 (will add it for rtabmap_ros later) * fixing website style * updated download links * locally deployable website with api * sweep doxygen issues * improved/revised doxygen main pages * removed examples empty page * Updated doxygen style * more concise doxygen groups * added api link on main readme * fixing utilite test error * fixing CommonFilteringGroundNormalsUp test * updated precisionRecall test bounds for Freak and brief descriptors * fixing scale check in ba tests * disabled tests on windows cuda build (missing dlls amd runner cannot test cuda anyway) * ceres: missing suitesparse dep in windows ci * adjusting recall thr for fast/freak * ficing more flaky tests * fixing flaky tests * disabled coverage in ros ci * Enable integration tests for ros ci jobs * loosing up some threshold for failing tests * trigger cache * fixing test data in ros ci. Updated flaky test for mac * slaking some test limit * Fixed rtabmap-detectMoreLoopClosures inverted output value * loosing up sift recall on mac * optimizer re-ordered distribution for reproducible results (mac g2o) * macos dump test crash log * combining all tests to save time on shared library reload. Also fixed Logs with missing arguments. * Added ENABLE_FORMAT_ERRORS cmake option * do test only one time * fixed all format warnings * format security android build errors * less verbose tests * updated ImuUThread test * fixed a log * Fixed libpointmatcher 2d normals eigen issue * Fixing libpointmatcher conversion issues * fixing libpointmatcher test on windows ci * cleanup comments, relax some test thr * disabled sequoia-intel ci build (too flaky, would need extensive testing directly on that machine)
339 lines
13 KiB
Python
339 lines
13 KiB
Python
#!/usr/bin/env python3
|
|
"""Generate the Doxygen "Parameter reference" page from Parameters.h.
|
|
|
|
The parameters are declared with the RTABMAP_PARAM* macros, so Doxygen only
|
|
ever sees the generated accessors -- one entry per parameter, spread over a
|
|
1900-member class page. This script reads the declarations instead and emits a
|
|
Markdown page with one table per group, giving the key, type, default value and
|
|
description side by side.
|
|
|
|
Handles what the declarations actually use:
|
|
- RTABMAP_PARAM, RTABMAP_PARAM_STR and RTABMAP_PARAM_COND
|
|
- declarations spanning several lines
|
|
- descriptions built with uFormat("... %s ...", kOther().c_str(), ...), whose
|
|
placeholders are resolved to the referenced parameter keys and linked
|
|
- the same key declared several times under different #if branches (build
|
|
options), whose defaults are all reported with their condition
|
|
|
|
Usage: generate_parameters_page.py --input Parameters.h --output parameters.md
|
|
"""
|
|
|
|
import argparse
|
|
import os
|
|
import re
|
|
import sys
|
|
|
|
MACROS = ('RTABMAP_PARAM_COND', 'RTABMAP_PARAM_STR', 'RTABMAP_PARAM')
|
|
|
|
# Groups are emitted in the order they first appear in Parameters.h (which
|
|
# follows the pipeline), with a short blurb where the prefix is not obvious.
|
|
GROUP_BLURBS = {
|
|
'Rtabmap': 'Top-level loop closure detection and map management.',
|
|
'Mem': 'Memory management: what is kept in STM/WM, what is transferred to LTM.',
|
|
'Kp': 'Bag-of-words dictionary used for global loop closure detection.',
|
|
'Vis': 'Visual registration (feature extraction, matching and PnP).',
|
|
'Icp': 'Geometric registration by iterative closest point.',
|
|
'Reg': 'Registration strategy shared by loop closures and proximity detection.',
|
|
'RGBD': 'Metric SLAM: graph, proximity detection and localization.',
|
|
'Grid': 'Local occupancy grid generation from each node.',
|
|
'GridGlobal': 'Assembly of the local grids into the global map.',
|
|
'Optimizer': 'Graph optimization back-end.',
|
|
'Marker': 'Fiducial marker (ArUco/AprilTag) detection and landmarks.',
|
|
'Odom': 'Odometry front-end shared settings.',
|
|
'Bayes': 'Bayes filter used for loop closure hypotheses.',
|
|
'Db': 'Database (long-term memory) storage.',
|
|
'Stereo': 'Stereo correspondence.',
|
|
}
|
|
|
|
|
|
def negate(condition):
|
|
"""Negation of a #if condition, kept readable for the generated page."""
|
|
if condition.startswith('!') and '&&' not in condition and '||' not in condition:
|
|
return condition[1:]
|
|
if re.match(r'^defined\([A-Za-z0-9_]+\)$', condition):
|
|
return '!' + condition
|
|
return '!(%s)' % condition
|
|
|
|
|
|
class Param(object):
|
|
def __init__(self, prefix, name, type_, default, description, branch):
|
|
self.prefix = prefix
|
|
self.name = name
|
|
self.type = type_
|
|
self.description = description
|
|
# (default, branch) pairs: more than one when the parameter is declared
|
|
# in several #if branches. `branch` is the innermost condition only:
|
|
# the branches are read in order, first match wins, so the enclosing
|
|
# negations would only repeat what the previous rows already said.
|
|
self.defaults = [(default, branch)]
|
|
|
|
@property
|
|
def key(self):
|
|
return '%s/%s' % (self.prefix, self.name)
|
|
|
|
@property
|
|
def accessor(self):
|
|
return 'k%s%s' % (self.prefix, self.name)
|
|
|
|
@property
|
|
def anchor(self):
|
|
"""Doxygen anchor of this parameter's row, for in-page links."""
|
|
return 'param_%s%s' % (self.prefix, self.name)
|
|
|
|
|
|
def split_args(text):
|
|
"""Split a macro argument list on top-level commas."""
|
|
args, depth, current, i, in_string = [], 0, [], 0, False
|
|
while i < len(text):
|
|
c = text[i]
|
|
if in_string:
|
|
if c == '\\':
|
|
current.append(text[i:i + 2])
|
|
i += 2
|
|
continue
|
|
in_string = c != '"'
|
|
elif c == '"':
|
|
in_string = True
|
|
elif c in '([':
|
|
depth += 1
|
|
elif c in ')]':
|
|
depth -= 1
|
|
elif c == ',' and depth == 0:
|
|
args.append(''.join(current).strip())
|
|
current = []
|
|
i += 1
|
|
continue
|
|
current.append(c)
|
|
i += 1
|
|
args.append(''.join(current).strip())
|
|
return args
|
|
|
|
|
|
def unescape(literal):
|
|
"""Concatenate adjacent C string literals and undo their escapes."""
|
|
out = []
|
|
for chunk in re.findall(r'"((?:[^"\\]|\\.)*)"', literal):
|
|
out.append(chunk.replace('\\"', '"').replace('\\n', ' ')
|
|
.replace('\\t', ' ').replace('\\\\', '\\'))
|
|
return ''.join(out) if out else literal.strip()
|
|
|
|
|
|
def parse(path):
|
|
"""Return the parameters of Parameters.h, in declaration order."""
|
|
with open(path, newline='') as f:
|
|
lines = f.read().replace('\r\n', '\n').split('\n')
|
|
|
|
params, order = {}, []
|
|
conditions = [] # #if nesting, innermost last; None marks an #else
|
|
statement, collecting = '', False
|
|
in_class = False
|
|
|
|
for line in lines:
|
|
stripped = line.strip()
|
|
|
|
# Everything before the class (include guard, macro definitions) would
|
|
# only add noise to the conditions.
|
|
if not in_class:
|
|
in_class = stripped.startswith('class ') and 'Parameters' in stripped
|
|
continue
|
|
|
|
if not collecting and stripped.startswith('#'):
|
|
directive = re.match(r'#\s*(ifdef|ifndef|if|elif|else|endif)\b\s*(.*)', stripped)
|
|
if directive:
|
|
kind, expr = directive.group(1), directive.group(2).strip()
|
|
if kind in ('ifdef', 'ifndef', 'if'):
|
|
if kind == 'ifdef':
|
|
expr = 'defined(%s)' % expr
|
|
elif kind == 'ifndef':
|
|
expr = '!defined(%s)' % expr
|
|
conditions.append(expr)
|
|
elif kind in ('elif', 'else') and conditions:
|
|
conditions[-1] = None if kind == 'else' else expr
|
|
elif kind == 'endif' and conditions:
|
|
conditions.pop()
|
|
continue
|
|
|
|
if not collecting:
|
|
if not re.match(r'\s*RTABMAP_PARAM', line):
|
|
continue
|
|
statement, collecting = line.strip(), True
|
|
else:
|
|
statement += ' ' + stripped
|
|
|
|
if statement.count('(') != statement.count(')'):
|
|
continue # declaration continues on the next line
|
|
collecting = False
|
|
|
|
macro = next(m for m in MACROS if statement.startswith(m))
|
|
args = split_args(statement[len(macro) + 1:statement.rindex(')')])
|
|
|
|
prefix, name = args[0], args[1]
|
|
if macro == 'RTABMAP_PARAM_STR':
|
|
type_, default, description = 'string', unescape(args[2]), args[3]
|
|
elif macro == 'RTABMAP_PARAM_COND':
|
|
type_, description = args[2], args[6]
|
|
default = '%s if `%s`, %s otherwise' % (args[4], args[3], args[5])
|
|
else:
|
|
type_, default, description = args[2], args[3], args[4]
|
|
|
|
branch = conditions[-1] if conditions else ''
|
|
key = '%s/%s' % (prefix, name)
|
|
if key in params:
|
|
params[key].defaults.append((default, branch))
|
|
else:
|
|
params[key] = Param(prefix, name, type_, default, description, branch)
|
|
order.append(key)
|
|
|
|
return [params[k] for k in order]
|
|
|
|
|
|
def accessor_link(param):
|
|
"""A link to the C++ accessor, labelled with the parameter key."""
|
|
return '@ref rtabmap::Parameters::%s() "%s"' % (param.accessor, param.key)
|
|
|
|
|
|
def key_cell(param):
|
|
"""The key column: the row's own anchor, then the link to the accessor."""
|
|
return '@anchor %s %s' % (param.anchor, accessor_link(param))
|
|
|
|
|
|
def page_link(param):
|
|
"""A link to the parameter's own row on this page."""
|
|
return '@ref %s "%s"' % (param.anchor, param.key)
|
|
|
|
|
|
def resolve_description(param, by_accessor):
|
|
"""Render the description, resolving uFormat() placeholders to key links."""
|
|
text = param.description.strip()
|
|
if text.startswith('uFormat('):
|
|
args = split_args(text[len('uFormat('):text.rindex(')')])
|
|
text = unescape(args[0])
|
|
for arg in args[1:]:
|
|
match = re.search(r'\bk([A-Za-z0-9]+)\(\)', arg)
|
|
replacement = arg.strip()
|
|
if match:
|
|
other = by_accessor.get('k' + match.group(1))
|
|
replacement = page_link(other) if other else match.group(1)
|
|
if '"%s"' in text:
|
|
text = text.replace('"%s"', replacement, 1)
|
|
else:
|
|
text = text.replace('%s', replacement, 1)
|
|
else:
|
|
text = unescape(text)
|
|
return escape_cell(text)
|
|
|
|
|
|
def escape_cell(text):
|
|
"""A table cell cannot contain a raw '|', and '<' would open an HTML tag."""
|
|
return text.replace('|', '\\|').replace('<', '<').replace('>', '>')
|
|
|
|
|
|
def format_defaults(param):
|
|
def code(value):
|
|
value = value.strip()
|
|
return '`%s`' % value if value else '`""`'
|
|
|
|
# Consecutive branches giving the same value are merged, so that a value
|
|
# that only changes in the last #else does not repeat three times.
|
|
merged = []
|
|
for value, branch in param.defaults:
|
|
if merged and merged[-1][0] == value:
|
|
merged[-1][1].append(branch)
|
|
else:
|
|
merged.append([value, [branch]])
|
|
|
|
if len(merged) == 1:
|
|
value, branches = merged[0]
|
|
if not any(branches) or None in branches:
|
|
return code(value)
|
|
return '%s with `%s`' % (code(value), escape_cell(' or '.join(branches)))
|
|
|
|
parts = []
|
|
for value, branches in merged:
|
|
if None in branches or not any(branches):
|
|
parts.append('%s otherwise' % code(value))
|
|
else:
|
|
parts.append('%s with `%s`' % (code(value), escape_cell(' or '.join(branches))))
|
|
return '<br>'.join(parts)
|
|
|
|
|
|
def render(params, source_name):
|
|
groups, order = {}, []
|
|
for p in params:
|
|
groups.setdefault(p.prefix, []).append(p)
|
|
if p.prefix not in order:
|
|
order.append(p.prefix)
|
|
|
|
by_accessor = {p.accessor: p for p in params}
|
|
|
|
out = []
|
|
out.append('Parameter reference {#parameters}')
|
|
out.append('===================')
|
|
out.append('')
|
|
out.append('Every setting in RTAB-Map is a `Group/Name` string key with a string value,')
|
|
out.append('collected in a rtabmap::ParametersMap. The %d parameters below are declared in'
|
|
% len(params))
|
|
out.append('`%s`; the same keys are used by rtabmap::Rtabmap and rtabmap::Odometry, by the'
|
|
% source_name)
|
|
out.append('applications, by the `--Param Group/Name value` command-line arguments of the')
|
|
out.append('tools and by the ROS wrappers, so a setting found here applies everywhere.')
|
|
out.append('')
|
|
out.append('~~~{.cpp}')
|
|
out.append('rtabmap::ParametersMap parameters;')
|
|
out.append('parameters.insert(rtabmap::ParametersPair(rtabmap::Parameters::kMemSTMSize(), "20"));')
|
|
out.append('rtabmap.init(parameters, "map.db");')
|
|
out.append('~~~')
|
|
out.append('')
|
|
out.append('Each key links to its accessor on rtabmap::Parameters, which is also how the')
|
|
out.append('key is spelled in code (`Parameters::kMemSTMSize()` for `Mem/STMSize`).')
|
|
out.append('Defaults given with a condition depend on how RTAB-Map was built; call')
|
|
out.append('rtabmap::Parameters::getDefaultParameters() to read the values of the build in use.')
|
|
out.append('')
|
|
out.append('**Groups:** ' + ', '.join(
|
|
'@ref parameters_%s "%s"' % (p, p) for p in order))
|
|
out.append('')
|
|
|
|
for prefix in order:
|
|
# @anchor rather than a "{#id}" heading: the latter would turn the
|
|
# heading into a section, which lands in the navigation tree whatever
|
|
# TOC_INCLUDE_HEADINGS says.
|
|
out.append('@anchor parameters_%s' % prefix)
|
|
out.append(prefix)
|
|
out.append('-' * len(prefix))
|
|
out.append('')
|
|
if prefix in GROUP_BLURBS:
|
|
out.append(GROUP_BLURBS[prefix])
|
|
out.append('')
|
|
out.append('| Key | Type | Default | Description |')
|
|
out.append('| --- | ---- | ------- | ----------- |')
|
|
for p in groups[prefix]:
|
|
out.append('| %s | %s | %s | %s |' % (
|
|
key_cell(p), p.type, format_defaults(p), resolve_description(p, by_accessor)))
|
|
out.append('')
|
|
|
|
return '\n'.join(out) + '\n'
|
|
|
|
|
|
def main():
|
|
parser = argparse.ArgumentParser(description=__doc__)
|
|
parser.add_argument('--input', required=True, help='path to Parameters.h')
|
|
parser.add_argument('--output', required=True, help='Markdown page to write')
|
|
args = parser.parse_args()
|
|
|
|
params = parse(args.input)
|
|
if not params:
|
|
sys.stderr.write('error: no parameter found in %s\n' % args.input)
|
|
return 1
|
|
|
|
directory = os.path.dirname(os.path.abspath(args.output))
|
|
if directory and not os.path.isdir(directory):
|
|
os.makedirs(directory)
|
|
with open(args.output, 'w') as f:
|
|
f.write(render(params, os.path.basename(args.input)))
|
|
sys.stderr.write('%s: %d parameters\n' % (args.output, len(params)))
|
|
return 0
|
|
|
|
|
|
if __name__ == '__main__':
|
|
sys.exit(main())
|