Adding point and cleaning up vector some
Adding Normal