This commit is contained in:
NikolajDanger
2022-10-26 14:30:13 +02:00
parent 0e46b0dbe2
commit ef5f297a47
2 changed files with 5 additions and 2 deletions

View File

@ -37,6 +37,9 @@ class Particle(object):
def copy(self):
return Particle(self.x, self.y, self.theta, self.weight)
def __str__(self) -> str:
return f"({self.x},{self.y},{self.theta})"
def estimate_pose(particles_list):
"""Estimate the pose from particles by computing the average position and orientation over all particles.