fixed particle filter bug, added wall detection