Refactored: Looking up newest head-shoulder transform for every tool.
Only looking up head-shoulder-transform once per tool perception.
Deleted old code in visualization of reaching direction.
Changed assumption from ''If I don't see it it's gone'' to ''It is where I have last seen it''.
Added topics for absolute distance between a tool and a body part and fixed calculation of distance to ray.