stfsm_write_fifo
stfsm_write_fifo(fsm, (uint32_t *)p, size_lb);
stfsm_write_fifo(fsm, tmp, write_mask + 1);