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