Revert "Removed periodic position update"

This reverts commit 4c95d41dc14d48b5231d7ae424a9c50a258e9829.
Readded wall detection