diff --git a/gcc/ChangeLog b/gcc/ChangeLog
index 97d3bb6144e8..e232f5294261 100644
--- a/gcc/ChangeLog
+++ b/gcc/ChangeLog
@@ -1,3 +1,9 @@
+2016-03-03  Martin Liska  <mliska@suse.cz>
+
+	PR tree-optimization/70043
+	* tree-vect-loop.c (optimize_mask_stores): Move iterator to
+	previous statement if we see a debug statement.
+
 2016-03-03  Richard Biener  <rguenther@suse.de>
 
 	PR tree-optimization/55936
diff --git a/gcc/testsuite/ChangeLog b/gcc/testsuite/ChangeLog
index 93919a086813..da7307ad2cfa 100644
--- a/gcc/testsuite/ChangeLog
+++ b/gcc/testsuite/ChangeLog
@@ -1,3 +1,8 @@
+2016-03-03  Ilya Enkovich  <enkovich.gnu@gmail.com>
+
+	PR tree-optimization/70043
+	* gfortran.dg/vect/pr70043.f90: New test.
+
 2016-03-03  Eric Botcazou  <ebotcazou@adacore.com>
 
 	* gnat.dg/specs/task1.ads: New test.
diff --git a/gcc/testsuite/gfortran.dg/vect/pr70043.f90 b/gcc/testsuite/gfortran.dg/vect/pr70043.f90
new file mode 100644
index 000000000000..36d6a0b3b90d
--- /dev/null
+++ b/gcc/testsuite/gfortran.dg/vect/pr70043.f90
@@ -0,0 +1,15 @@
+! { dg-do compile  }
+! { dg-additional-options "-Ofast -g" }
+! { dg-additional-options "-march=haswell" { target i?86-*-* x86_64-*-* } }
+
+subroutine fn1(a, b)
+  real(8), intent(in) ::  b(100)
+  real(8), intent(inout) :: a(100)
+  real(8) c
+  do i=0,100
+     if( a(i) < 0.0 ) then
+        c =  a(i) * b(i)
+        a(i) = a(i) - c / b(i)
+     endif
+  enddo
+end subroutine fn1
diff --git a/gcc/tree-vect-loop.c b/gcc/tree-vect-loop.c
index 627ff1c5cf38..0cd8f750dbc6 100644
--- a/gcc/tree-vect-loop.c
+++ b/gcc/tree-vect-loop.c
@@ -7090,7 +7090,10 @@ optimize_mask_stores (struct loop *loop)
 
 	      /* Skip debug statements.  */
 	      if (is_gimple_debug (gsi_stmt (gsi)))
-		continue;
+		{
+		  gsi_prev (&gsi);
+		  continue;
+		}
 	      stmt1 = gsi_stmt (gsi);
 	      /* Do not consider statements writing to memory or having
 		 volatile operand.  */