Start to clean up vector math library