pi const added; new angle func for vec3d