diff --git a/transition_machine/src/Action.cpp b/transition_machine/src/Action.cpp
index 0dab75d52bfe917d350d28b23c33c342ff0b996a..aec28111e50b61dd5334c7c2f9d44a44503d8650 100644
--- a/transition_machine/src/Action.cpp
+++ b/transition_machine/src/Action.cpp
@@ -33,7 +33,11 @@ bool Action::appliable(Config & config)
 
 void Action::undo(Config & config)
 {
+  if (ProgramParameters::debug)
+    fprintf(stderr, "Head = %d, will move back of %d\n", config.getHead(), headMovement);
   config.moveHead(-headMovement);
+  if (ProgramParameters::debug)
+    fprintf(stderr, "Head = %d\n", config.getHead());
 
   for(int i = sequence.size()-1; i >= 0; i--)
     sequence[i].undo(config, sequence[i]);
@@ -73,7 +77,11 @@ void Action::undo(Config & config)
 
 void Action::undoOnlyStack(Config & config)
 {
+  if (ProgramParameters::debug)
+    fprintf(stderr, "Head = %d, will move back of %d\n", config.getHead(), headMovement);
   config.moveHead(-headMovement);
+  if (ProgramParameters::debug)
+    fprintf(stderr, "Head = %d\n", config.getHead());
 
   for(int i = sequence.size()-1; i >= 0; i--)
   {