added stable goal code - returns gRange,angle,Hot goal