Fixed getting stuck in wall bug.
Merge branch 'testing' of github.com:jappeace/hw-isgp-kbs into testing