diff --git a/xml-handler/src/resources/sweep/MP5000Sweep.xml b/xml-handler/src/resources/sweep/MP5000Sweep.xml
index cbc063c..704e20a 100644
--- a/xml-handler/src/resources/sweep/MP5000Sweep.xml
+++ b/xml-handler/src/resources/sweep/MP5000Sweep.xml
@@ -555,6 +555,7 @@
                                 step = self.slot_idx .. self.channel_idx .. "_step_step",
                                 waitall_steps = self.slot_idx .. self.channel_idx .. "_step_waitall_",
                                 step_notify = self.slot_idx .. self.channel_idx .. "_step_done",
+                                delay_sweep = self.slot_idx .. self.channel_idx .. "_step_delay_sweep",
                                 wait_sweep = self.slot_idx .. self.channel_idx .. "_step_wait_sweep",
                                 measure = self.slot_idx .. self.channel_idx .. "_step_measure",
                                 waitall_step_meas = self.slot_idx .. self.channel_idx .. "_step_other_measure_waitall_",
@@ -585,6 +586,11 @@
                                     step_source_complete_events)
                             end
 
+                            -- Adding step-to-sweep-delay    --
+                            if sweep_source_event ~= nil then
+                                tm_add.delay.constant(self.trigger_model, block.delay_sweep, stepToSweepDelay)
+                            end
+
                             -- Notify other channels that the steppers are done stepping
                             tm_add.notify(self.trigger_model, block.step_notify, self.event_source)
 
@@ -1307,7 +1313,7 @@
             local numberOfSteps    = %STEP-COUNT%
             local numberOfSweeps   = %SWEEP-POINTS%
 
-            local stepToSweepDelay = %STEP-TO-SWEEP-DELAY%
+            stepToSweepDelay = %STEP-TO-SWEEP-DELAY%
 
             local nplc             = %NPLC%