--- a/drivers/mtd/chips/cfi_cmdset_0002.c +++ b/drivers/mtd/chips/cfi_cmdset_0002.c @@ -1637,7 +1637,7 @@ static int __xipram do_write_oneword(str } if (chip_good(map, adr, datum)) - break; + goto enable_xip; /* Latency issues. Drop the lock, wait a while and retry */ UDELAY(map, chip, adr, 1); @@ -1654,6 +1654,8 @@ static int __xipram do_write_oneword(str goto retry; } } + + enable_xip: xip_enable(map, chip, adr); op_done: if (mode == FL_OTP_WRITE) @@ -2232,7 +2234,6 @@ static int cfi_amdstd_panic_write(struct return 0; } - /* * Handle devices with one erase region, that only implement * the chip erase command. @@ -2300,7 +2301,7 @@ static int __xipram do_erase_chip(struct } if (chip_good(map, adr, map_word_ff(map))) - break; + goto op_done; if (time_after(jiffies, timeo)) { printk(KERN_WARNING "MTD %s(): software timeout\n", @@ -2324,6 +2325,7 @@ static int __xipram do_erase_chip(struct } } + op_done: chip->state = FL_READY; xip_enable(map, chip, adr); DISABLE_VPP(map); @@ -2397,7 +2399,7 @@ static int __xipram do_erase_oneblock(st if (chip_good(map, adr, map_word_ff(map))) { xip_enable(map, chip, adr); - break; + goto op_done; } if (time_after(jiffies, timeo)) { @@ -2423,6 +2425,7 @@ static int __xipram do_erase_oneblock(st } } + op_done: chip->state = FL_READY; DISABLE_VPP(map); put_chip(map, chip, adr);