Provide support for IIC_M_NOSTOP/IIC_M_NOSTART for bit-banging and
otherwise low-level controllers. Reviewed by: thompsa
This commit is contained in:
parent
affa18265a
commit
134a9563c7
@ -363,7 +363,7 @@ iicbus_transfer(device_t bus, struct iic_msg *msgs, uint32_t nmsgs)
|
|||||||
int
|
int
|
||||||
iicbus_transfer_gen(device_t dev, struct iic_msg *msgs, uint32_t nmsgs)
|
iicbus_transfer_gen(device_t dev, struct iic_msg *msgs, uint32_t nmsgs)
|
||||||
{
|
{
|
||||||
int i, error, lenread, lenwrote, nkid;
|
int i, error, lenread, lenwrote, nkid, rpstart, addr;
|
||||||
device_t *children, bus;
|
device_t *children, bus;
|
||||||
|
|
||||||
if ((error = device_get_children(dev, &children, &nkid)) != 0)
|
if ((error = device_get_children(dev, &children, &nkid)) != 0)
|
||||||
@ -373,14 +373,38 @@ iicbus_transfer_gen(device_t dev, struct iic_msg *msgs, uint32_t nmsgs)
|
|||||||
return (EIO);
|
return (EIO);
|
||||||
}
|
}
|
||||||
bus = children[0];
|
bus = children[0];
|
||||||
|
rpstart = 0;
|
||||||
free(children, M_TEMP);
|
free(children, M_TEMP);
|
||||||
for (i = 0, error = 0; i < nmsgs && error == 0; i++) {
|
for (i = 0, error = 0; i < nmsgs && error == 0; i++) {
|
||||||
|
addr = msgs[i].slave;
|
||||||
if (msgs[i].flags & IIC_M_RD)
|
if (msgs[i].flags & IIC_M_RD)
|
||||||
error = iicbus_block_read(bus, msgs[i].slave,
|
addr |= LSB;
|
||||||
msgs[i].buf, msgs[i].len, &lenread);
|
|
||||||
else
|
else
|
||||||
error = iicbus_block_write(bus, msgs[i].slave,
|
addr &= ~LSB;
|
||||||
msgs[i].buf, msgs[i].len, &lenwrote);
|
|
||||||
|
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 */
|
||||||
|
}
|
||||||
}
|
}
|
||||||
return (error);
|
return (error);
|
||||||
}
|
}
|
||||||
|
Loading…
x
Reference in New Issue
Block a user