Advantech MIO-5850, Руководство пользователя

Страница: 78 / 82

MIO-5850 User Manual 70
while ((inb(STS_PORT) & EC_STS_OBF) == 0)
{
if (--retries == 0)
return 0xFF; // timeout obf
}
return 0;
}
//
================================================================
=============
// ec_prot_trans
//
================================================================
=============
uint8_t ec_prot_trans(uint8_t cmd, uint8_t ctl, uint8_t dev, uint8_t len, uint8_t *dat)
{
uint8_t i;
uint8_t *datp;
if ((cmd & EC_CMD_MASK) == EC_CMD_READ)
memset(dat, 0, len);
// cmd
if (ec_wait_ibe())
return 0xFF;
outb(CMD_PORT, cmd);
// ctl
if (ec_wait_ibe())
return 0xFF;
outb(DAT_PORT, ctl);
// dev
if (ec_wait_ibe())
return 0xFF;
outb(DAT_PORT, dev);
// len
if (ec_wait_ibe())
return 0xFF;
outb(DAT_PORT, len);
// dat
datp = dat;
if ((cmd & EC_CMD_MASK) == EC_CMD_READ)
{