Implemented normal estimation/orientation