moved angleAverage to drakeUtil