Real-time generation of normal estimation

Added Pipeline step to genete normal estimation in real time, moved
normals to pipelinecontainer instead of pipelineDatacontainer
Switched stage 5 and 6 (icp and normals)

Prepared for normal-based estimation tracking