diff --git a/sys/dev/iicbus/iiconf.c b/sys/dev/iicbus/iiconf.c index e59dc35f18c..1610b351e74 100644 --- a/sys/dev/iicbus/iiconf.c +++ b/sys/dev/iicbus/iiconf.c @@ -363,7 +363,7 @@ iicbus_transfer(device_t bus, struct iic_msg *msgs, uint32_t nmsgs) int iicbus_transfer_gen(device_t dev, struct iic_msg *msgs, uint32_t nmsgs) { - int i, error, lenread, lenwrote, nkid, rpstart, addr; + int i, error, lenread, lenwrote, nkid; device_t *children, bus; if ((error = device_get_children(dev, &children, &nkid)) != 0) @@ -373,38 +373,14 @@ iicbus_transfer_gen(device_t dev, struct iic_msg *msgs, uint32_t nmsgs) return (EIO); } bus = children[0]; - rpstart = 0; free(children, M_TEMP); for (i = 0, error = 0; i < nmsgs && error == 0; i++) { - addr = msgs[i].slave; if (msgs[i].flags & IIC_M_RD) - addr |= LSB; + error = iicbus_block_read(bus, msgs[i].slave, + msgs[i].buf, msgs[i].len, &lenread); else - addr &= ~LSB; - - if (!(msgs[i].flags & IIC_M_NOSTART)) { - if (rpstart) - error = iicbus_repeated_start(bus, addr, 0); - else - error = iicbus_start(bus, addr, 0); - } - - if (error) - break; - - if (msgs[i].flags & IIC_M_RD) - error = iicbus_read(bus, msgs[i].buf, msgs[i].len, - &lenread, IIC_LAST_READ, 0); - else - error = iicbus_write(bus, msgs[i].buf, msgs[i].len, - &lenwrote, 0); - - if (!(msgs[i].flags & IIC_M_NOSTOP)) { - rpstart = 0; - iicbus_stop(bus); - } else { - rpstart = 1; /* Next message gets repeated start */ - } + error = iicbus_block_write(bus, msgs[i].slave, + msgs[i].buf, msgs[i].len, &lenwrote); } return (error); }