Navigation under uncertainty: Trajectory prediction and occlusion reasoning with switching dynamical systems