Add angle function for 3-vector