add vec_normalize and fix some bug