mantis_risc_program(mantis);
        mmwrite(cpu_to_le32(mantis->risc_dma), MANTIS_RISC_START);
-       mmwrite(MANTIS_GPIF_RDWRN, MANTIS_GPIF_ADDR);
+//     mmwrite(MANTIS_GPIF_RDWRN, MANTIS_GPIF_ADDR);
+       mmwrite(mmread(MANTIS_GPIF_ADDR) | MANTIS_GPIF_RDWRN, MANTIS_GPIF_ADDR);
 
        mmwrite(0, MANTIS_DMA_CTL);
        mantis->last_block = mantis->finished_block = 0;
        mask = mmread(MANTIS_INT_MASK);
        dprintk(verbose, MANTIS_DEBUG, 1, "Mantis Stop DMA engine");
 
+       mmwrite((mmread(MANTIS_GPIF_ADDR) & (~(MANTIS_GPIF_RDWRN))), MANTIS_GPIF_ADDR);
+
        mmwrite((mmread(MANTIS_DMA_CTL) & ~(MANTIS_FIFO_EN |
                                            MANTIS_DCAP_EN |
                                            MANTIS_RISC_EN)), MANTIS_DMA_CTL);