Updated accuracy and speed

Changed position of evaluatebaroaltitude and get temp to improve speed and corrected groundbaro calculation to improve accuracy