3600 RAD2DEG*acos($ros_xyz_hee[0]/sqrt($ros_xyz_hee[0]*$ros_xyz_hee[0]+$ros_xyz_hee[1]*$ros_xyz_hee[1]))*Sign(-$ros_xyz_hee[1])