Variables | |
tuple | app_model = da.DetectionAppearance(cov=np.matrix([[(.03*.03), 0], [0, (.03*.03)]])) |
tuple | cur_pos = pose.pos.copy() |
cur_set = particles | |
tuple | display = nd.RobotDisp("particle filter", size = 2, draw_center=True, meters_radius=10) |
tuple | draw_func = ft.partial(rm.draw_weighted_Pose2D, display, max_weight) |
tuple | filter = pf.PFilter(motion_model, app_model) |
tuple | max_weight = app_model.weight(np.matrix([1.0, 0.0]).T, t2d.Pose2D(1.0, 0.0, 0.0)) |
tuple | motion_model = rm.RobotMotion(mvar) |
tuple | mvar = rm.motion_var() |
tuple | particles = rm.make_set(mvar, pose, 100) |
tuple | pose = t2d.Pose2D(0.0, 0.0, 0.0) |
tuple | scur_pos = display.to_screen(cur_pos) |
tuple | velocity = np.matrix([0.01, 0.0]) |
tuple pfilter::test::app_model = da.DetectionAppearance(cov=np.matrix([[(.03*.03), 0], [0, (.03*.03)]])) |
pfilter::test::cur_pos = pose.pos.copy() |
tuple pfilter::test::cur_set = particles |
tuple pfilter::test::display = nd.RobotDisp("particle filter", size = 2, draw_center=True, meters_radius=10) |
tuple pfilter::test::draw_func = ft.partial(rm.draw_weighted_Pose2D, display, max_weight) |
tuple pfilter::test::filter = pf.PFilter(motion_model, app_model) |
tuple pfilter::test::max_weight = app_model.weight(np.matrix([1.0, 0.0]).T, t2d.Pose2D(1.0, 0.0, 0.0)) |
tuple pfilter::test::motion_model = rm.RobotMotion(mvar) |
tuple pfilter::test::mvar = rm.motion_var() |
tuple pfilter::test::particles = rm.make_set(mvar, pose, 100) |
tuple pfilter::test::pose = t2d.Pose2D(0.0, 0.0, 0.0) |
tuple pfilter::test::scur_pos = display.to_screen(cur_pos) |
tuple pfilter::test::velocity = np.matrix([0.01, 0.0]) |