Fix logic inversion that can lead to the out-of-the-bounds write

Fix logic inversion that can lead to the out-of-the-bounds write #596