add EstimateTheta and EstimatePhi function