Bug fixed false unit vector calculation