Add vector length and vector normalize functions