opencv calculate angle between two points