Fixed time stamp handling for attitude SP

src/uas/UAS.cc

@@ -1133,9 +1133,9 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message)
             emit attitudeThrustSetPointChanged(this, roll, pitch, yaw, out.thrust, time);
 
             // For plotting emit roll sp, pitch sp and yaw sp values
-            emit valueChanged(uasId, "roll sp", "rad", roll, out.time_boot_ms);
-            emit valueChanged(uasId, "pitch sp", "rad", pitch, out.time_boot_ms);
-            emit valueChanged(uasId, "yaw sp", "rad", yaw, out.time_boot_ms);
+            emit valueChanged(uasId, "roll sp", "rad", roll, time);
+            emit valueChanged(uasId, "pitch sp", "rad", pitch, time);
+            emit valueChanged(uasId, "yaw sp", "rad", yaw, time);
         }
             break;
         case MAVLINK_MSG_ID_MISSION_COUNT: