Add wall tracking and angle reset

Signed-off-by: Maslov Nikita <wkernelteam@gmail.ru>