This commit is contained in:
NikolajDanger
2022-10-10 15:01:54 +02:00
parent af3064ad4c
commit 8884013910

View File

@ -254,7 +254,7 @@ try:
particle.add_uncertainty(particles, SIGMA, SIGMA_THETA)
est_pose = particle.estimate_pose(particles) # The estimate of the robots current pose
calc_weight(est_pose, landmark_values)
est_weight = est_pose.weight
est_weight = est_pose.weight * 10**5
print("est_weight:", est_weight)
if est_weight > 1:
draw_world(est_pose, particles, world)