One more fix, inverse was actually needed in one case.
							parent
							
								
									b82d054aaa
								
							
						
					
					
						commit
						9b62b326c9
					
				|  | @ -114,7 +114,7 @@ pair<sharedPose2Graph, sharedPose2Config> load2D(const string& filename, | ||||||
| 			if (maxID && (id1 >= maxID || id2 >= maxID)) continue; | 			if (maxID && (id1 >= maxID || id2 >= maxID)) continue; | ||||||
| 
 | 
 | ||||||
| 
 | 
 | ||||||
| 			measured = Pose2(x, y, yaw); | 			measured = inverse(Pose2(x, y, yaw)); | ||||||
| 
 | 
 | ||||||
| //			SharedGaussian noise = noiseModel::Gaussian::Covariance(m, smart);
 | //			SharedGaussian noise = noiseModel::Gaussian::Covariance(m, smart);
 | ||||||
| 			// hack use diagonal for now !
 | 			// hack use diagonal for now !
 | ||||||
|  |  | ||||||
		Loading…
	
		Reference in New Issue