add normal image to published output on topic /camera/depth/normal
Refactored Code for start of term