@@ -61,30 +61,6 @@ void Parameters::ParseParameters() {
6161 std::cout << " NumRobots (default): " << pNumRobots << std::endl;
6262 }
6363
64- if (toml_config[" NumFeatures" ].value <int >()) {
65- pNumFeatures = toml_config[" NumFeatures" ].value <int >().value ();
66- } else {
67- std::cout << " NumFeatures (default): " << pNumFeatures << std::endl;
68- }
69-
70- if (toml_config[" NumPolygons" ].value <int >()) {
71- pNumPolygons = toml_config[" NumPolygons" ].value <int >().value ();
72- } else {
73- std::cout << " NumPolygons (default): " << pNumPolygons << std::endl;
74- }
75-
76- if (toml_config[" MaxVertices" ].value <int >()) {
77- pMaxVertices = toml_config[" MaxVertices" ].value <int >().value ();
78- } else {
79- std::cout << " MaxVertices (default): " << pMaxVertices << std::endl;
80- }
81-
82- if (toml_config[" PolygonRadius" ].value <double >()) {
83- pPolygonRadius = toml_config[" PolygonRadius" ].value <double >().value ();
84- } else {
85- std::cout << " PolygonRadius (default): " << pPolygonRadius << std::endl;
86- }
87-
8864 auto toml_IO = toml_config[" IO" ];
8965 if (toml_IO[" PlotScale" ].value <double >()) {
9066 pPlotScale = toml_IO[" PlotScale" ].value <double >().value ();
@@ -146,6 +122,11 @@ void Parameters::ParseParameters() {
146122 auto toml_EnvironmentIDF = toml_config[" Environment" ][" IDF" ];
147123
148124 if (toml_EnvironmentIDF) {
125+ if (toml_EnvironmentIDF[" NumGaussianFeatures" ].value <int >()) {
126+ pNumGaussianFeatures = toml_EnvironmentIDF[" NumGaussianFeatures" ].value <int >().value ();
127+ } else {
128+ std::cout << " NumGaussianFeatures (default): " << pNumGaussianFeatures << std::endl;
129+ }
149130 auto toml_TruncationBND =
150131 toml_EnvironmentIDF[" TruncationBND" ].value <double >();
151132 auto toml_Norm = toml_EnvironmentIDF[" Norm" ].value <double >();
@@ -176,6 +157,25 @@ void Parameters::ParseParameters() {
176157 if (toml_MaxPeak) {
177158 pMaxPeak = toml_MaxPeak.value ();
178159 }
160+
161+ if (toml_EnvironmentIDF[" NumPolygons" ].value <int >()) {
162+ pNumPolygons = toml_EnvironmentIDF[" NumPolygons" ].value <int >().value ();
163+ } else {
164+ std::cout << " NumPolygons (default): " << pNumPolygons << std::endl;
165+ }
166+
167+ if (toml_EnvironmentIDF[" MaxVertices" ].value <int >()) {
168+ pMaxVertices = toml_EnvironmentIDF[" MaxVertices" ].value <int >().value ();
169+ } else {
170+ std::cout << " MaxVertices (default): " << pMaxVertices << std::endl;
171+ }
172+
173+ if (toml_EnvironmentIDF[" PolygonRadius" ].value <double >()) {
174+ pPolygonRadius = toml_EnvironmentIDF[" PolygonRadius" ].value <double >().value ();
175+ } else {
176+ std::cout << " PolygonRadius (default): " << pPolygonRadius << std::endl;
177+ }
178+
179179 if (toml_UnknownImportance) {
180180 pUnknownImportance = toml_UnknownImportance.value ();
181181 }
@@ -262,7 +262,6 @@ void Parameters::ParseParameters() {
262262
263263void Parameters::PrintParameters () const {
264264 std::cout << " NumRobots: " << pNumRobots << std::endl;
265- std::cout << " NumFeatures: " << pNumFeatures << std::endl;
266265 std::cout << " NumPolygons: " << pNumPolygons << std::endl;
267266 std::cout << " MaxVertices: " << pMaxVertices << std::endl;
268267 std::cout << " PolygonRadius: " << pPolygonRadius << std::endl;
@@ -279,13 +278,18 @@ void Parameters::PrintParameters() const {
279278 std::cout << " UpdateExplorationMap: " << pUpdateExplorationMap << std::endl;
280279 std::cout << " UpdateSystemMap: " << pUpdateSystemMap << std::endl;
281280
281+ std::cout << " NumGaussianFeatures: " << pNumGaussianFeatures << std::endl;
282282 std::cout << " TruncationBND: " << pTruncationBND << std::endl;
283283 std::cout << " Norm: " << pNorm << std::endl;
284284 std::cout << " MinSigma: " << pMinSigma << std::endl;
285285 std::cout << " MaxSigma: " << pMaxSigma << std::endl;
286286 std::cout << " MinPeak: " << pMinPeak << std::endl;
287287 std::cout << " MaxPeak: " << pMaxPeak << std::endl;
288288
289+ std::cout << " pNumPolygons: " << pNumPolygons << std::endl;
290+ std::cout << " pMaxVertices: " << pMaxVertices << std::endl;
291+ std::cout << " pPolygonRadius: " << pPolygonRadius << std::endl;
292+
289293 std::cout << " UnknownImportance: " << pUnknownImportance << std::endl;
290294 std::cout << " RobotMapUseUnknownImportance: " << pRobotMapUseUnknownImportance
291295 << std::endl;
0 commit comments