Skip to content
GitLab
Menu
Projects
Groups
Snippets
/
Help
Help
Support
Community forum
Keyboard shortcuts
?
Submit feedback
Contribute to GitLab
Sign in
Toggle navigation
Menu
Open sidebar
mobile_robotics
ADC
ADC_2021
iri_adc_landmarks_slam_solver
Commits
8fd6a0a4
Commit
8fd6a0a4
authored
Nov 14, 2021
by
Alejandro Lopez Gestoso
Browse files
Added harcoded minimum road length
parent
fab69366
Changes
1
Hide whitespace changes
Inline
Side-by-side
src/adc_landmarks_slam_solver_alg.cpp
View file @
8fd6a0a4
...
...
@@ -94,6 +94,7 @@ bool AdcLandmarksSlamSolverAlgorithm::load_from_xodr(const std::string& _landmar
TOpendriveWorldPose
world
;
try
{
road
.
set_scale_factor
(
_scale
);
road
.
set_min_road_length
(
0.01
);
road
.
load
(
_landmarks_file
);
std
::
map
<
double
,
LandmarkInfo
>
().
swap
(
this
->
landmarks_
);
...
...
@@ -441,4 +442,4 @@ void AdcLandmarksSlamSolverAlgorithm::add_newest_frame_to_ceres(bool _estimated_
ceres
::
CostFunction
*
cost_function
=
new
ceres
::
AutoDiffCostFunction
<
EstimatedPoseResidual2D
,
3
,
3
>
(
new
EstimatedPoseResidual2D
(
this
->
frames_data_
.
back
().
robot_state
,
this
->
config_
.
amcl_pose_estimated_sigma
,
this
->
config_
.
amcl_pose_estimated_sigma
,
this
->
config_
.
amcl_pose_estimated_sigma
));
this
->
problem_
.
AddResidualBlock
(
cost_function
,
NULL
,
this
->
frames_data_
.
back
().
robot_state
.
data
());
}
}
\ No newline at end of file
}
Write
Preview
Supports
Markdown
0%
Try again
or
attach a new file
.
Attach a file
Cancel
You are about to add
0
people
to the discussion. Proceed with caution.
Finish editing this message first!
Cancel
Please
register
or
sign in
to comment