diff --git a/src/main.c b/src/main.c
index bb97250..78e6a0c 100644
--- a/src/main.c
+++ b/src/main.c
@@ -25,6 +25,7 @@
 #include "mgos_imu.h"
 #include "mgos_barometer.h"
 #include <fcntl.h>
+#include <math.h>
 #include <sys/ioctl.h>
 
 #define I2CBUSNR    5
@@ -161,11 +162,13 @@ bool do_baro(struct mgos_barometer *sensor) {
   if (!sensor)
     return false;
 
-  if (mgos_barometer_get_pressure(sensor, &pressure))
-    LOG(LL_INFO, ("Pressure %.2fPa", pressure));
+  if (!mgos_barometer_get_pressure(sensor, &pressure))
+    pressure=NAN;
 
-  if (mgos_barometer_get_temperature(sensor, &temperature)) 
-    LOG(LL_INFO, ("Temperature %.2fC", temperature));
+  if (!mgos_barometer_get_temperature(sensor, &temperature)) 
+    temperature=NAN;
+
+  LOG(LL_INFO, ("temperature=%.2fC pressure=%.0fPa", temperature, pressure));
 
   return true;
 }