/// <summary>
/// Reset
/// </summary>
public void Reset()
{
LastMapUpdatePose = new Vector3(float.MaxValue, float.MaxValue, float.MaxValue);
LastScanMatchPose = new Vector3(0.0f, 0.0f, 0.0f);
MapRep.Reset();
}
/// <summary>
/// Reset
/// </summary>
public void Reset()
{
MapRep.Reset();
// Set initial poses
MatchPose = startPose;
LastMapUpdatePose = new Vector3(float.MinValue, float.MinValue, float.MinValue);
}