Corrected Normal Vector, display functions and unittest