✨
This commit is contained in:
@ -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.
|
||||
|
Reference in New Issue
Block a user