mstatus_tdi
iowrite32(ioread32(I2C_REG_STS(alg_data)) | mstatus_tdi | mstatus_afi,
iowrite32(stat | mstatus_tdi | mstatus_afi, I2C_REG_STS(alg_data));
if ((stat = ioread32(I2C_REG_STS(alg_data))) & mstatus_tdi) {