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]) |