Goal inference with Rao-Blackwellized Particle Filters