Revision ab17b46d hw/omap2.c
b/hw/omap2.c | ||
---|---|---|
1447 | 1447 |
|
1448 | 1448 |
#define EAC_BUF_LEN 1024 |
1449 | 1449 |
uint32_t rxbuf[EAC_BUF_LEN]; |
1450 |
int rxoff; |
|
1450 | 1451 |
int rxlen; |
1451 | 1452 |
int rxavail; |
1452 | 1453 |
uint32_t txbuf[EAC_BUF_LEN]; |
... | ... | |
1478 | 1479 |
|
1479 | 1480 |
static inline void omap_eac_in_dmarequest_update(struct omap_eac_s *s) |
1480 | 1481 |
{ |
1481 |
qemu_set_irq(s->codec.rxdrq, s->codec.rxavail + s->codec.rxlen &&
|
|
1482 |
qemu_set_irq(s->codec.rxdrq, (s->codec.rxavail || s->codec.rxlen) &&
|
|
1482 | 1483 |
((s->codec.config[1] >> 12) & 1)); /* DMAREN */ |
1483 | 1484 |
} |
1484 | 1485 |
|
... | ... | |
1490 | 1491 |
|
1491 | 1492 |
static inline void omap_eac_in_refill(struct omap_eac_s *s) |
1492 | 1493 |
{ |
1493 |
int left, start = 0; |
|
1494 |
|
|
1495 |
s->codec.rxlen = MIN(s->codec.rxavail, EAC_BUF_LEN); |
|
1496 |
s->codec.rxavail -= s->codec.rxlen; |
|
1497 |
|
|
1498 |
for (left = s->codec.rxlen << 2; left; start = (EAC_BUF_LEN << 2) - left) |
|
1499 |
left -= AUD_read(s->codec.in_voice, |
|
1500 |
(uint8_t *) s->codec.rxbuf + start, left); |
|
1494 |
int left = MIN(EAC_BUF_LEN - s->codec.rxlen, s->codec.rxavail) << 2; |
|
1495 |
int start = ((s->codec.rxoff + s->codec.rxlen) & (EAC_BUF_LEN - 1)) << 2; |
|
1496 |
int leftwrap = MIN(left, (EAC_BUF_LEN << 2) - start); |
|
1497 |
int recv = 1; |
|
1498 |
uint8_t *buf = (uint8_t *) s->codec.rxbuf + start; |
|
1499 |
|
|
1500 |
left -= leftwrap; |
|
1501 |
start = 0; |
|
1502 |
while (leftwrap && (recv = AUD_read(s->codec.in_voice, buf + start, |
|
1503 |
leftwrap)) > 0) { /* Be defensive */ |
|
1504 |
start += recv; |
|
1505 |
leftwrap -= recv; |
|
1506 |
} |
|
1507 |
if (recv <= 0) |
|
1508 |
s->codec.rxavail = 0; |
|
1509 |
else |
|
1510 |
s->codec.rxavail -= start >> 2; |
|
1511 |
s->codec.rxlen += start >> 2; |
|
1512 |
|
|
1513 |
if (recv > 0 && left > 0) { |
|
1514 |
start = 0; |
|
1515 |
while (left && (recv = AUD_read(s->codec.in_voice, |
|
1516 |
(uint8_t *) s->codec.rxbuf + start, |
|
1517 |
left)) > 0) { /* Be defensive */ |
|
1518 |
start += recv; |
|
1519 |
left -= recv; |
|
1520 |
} |
|
1521 |
if (recv <= 0) |
|
1522 |
s->codec.rxavail = 0; |
|
1523 |
else |
|
1524 |
s->codec.rxavail -= start >> 2; |
|
1525 |
s->codec.rxlen += start >> 2; |
|
1526 |
} |
|
1501 | 1527 |
} |
1502 | 1528 |
|
1503 | 1529 |
static inline void omap_eac_out_empty(struct omap_eac_s *s) |
1504 | 1530 |
{ |
1505 |
int left, start = 0; |
|
1531 |
int left = s->codec.txlen << 2; |
|
1532 |
int start = 0; |
|
1533 |
int sent = 1; |
|
1534 |
|
|
1535 |
while (left && (sent = AUD_write(s->codec.out_voice, |
|
1536 |
(uint8_t *) s->codec.txbuf + start, |
|
1537 |
left)) > 0) { /* Be defensive */ |
|
1538 |
start += sent; |
|
1539 |
left -= sent; |
|
1540 |
} |
|
1506 | 1541 |
|
1507 |
for (left = s->codec.txlen << 2; left; start = (s->codec.txlen << 2) - left) |
|
1508 |
left -= AUD_write(s->codec.out_voice, |
|
1509 |
(uint8_t *) s->codec.txbuf + start, left); |
|
1542 |
if (!sent) { |
|
1543 |
s->codec.txavail = 0; |
|
1544 |
omap_eac_out_dmarequest_update(s); |
|
1545 |
} |
|
1510 | 1546 |
|
1511 |
s->codec.txavail -= s->codec.txlen;
|
|
1512 |
s->codec.txlen = 0; |
|
1547 |
if (start)
|
|
1548 |
s->codec.txlen = 0;
|
|
1513 | 1549 |
} |
1514 | 1550 |
|
1515 | 1551 |
static void omap_eac_in_cb(void *opaque, int avail_b) |
... | ... | |
1517 | 1553 |
struct omap_eac_s *s = (struct omap_eac_s *) opaque; |
1518 | 1554 |
|
1519 | 1555 |
s->codec.rxavail = avail_b >> 2; |
1520 |
omap_eac_in_dmarequest_update(s);
|
|
1556 |
omap_eac_in_refill(s);
|
|
1521 | 1557 |
/* TODO: possibly discard current buffer if overrun */ |
1558 |
omap_eac_in_dmarequest_update(s); |
|
1522 | 1559 |
} |
1523 | 1560 |
|
1524 | 1561 |
static void omap_eac_out_cb(void *opaque, int free_b) |
... | ... | |
1526 | 1563 |
struct omap_eac_s *s = (struct omap_eac_s *) opaque; |
1527 | 1564 |
|
1528 | 1565 |
s->codec.txavail = free_b >> 2; |
1529 |
if (s->codec.txlen > s->codec.txavail)
|
|
1530 |
s->codec.txlen = s->codec.txavail;
|
|
1531 |
omap_eac_out_empty(s);
|
|
1532 |
omap_eac_out_dmarequest_update(s); |
|
1566 |
if (s->codec.txlen) |
|
1567 |
omap_eac_out_empty(s);
|
|
1568 |
else
|
|
1569 |
omap_eac_out_dmarequest_update(s);
|
|
1533 | 1570 |
} |
1534 | 1571 |
|
1535 | 1572 |
static void omap_eac_enable_update(struct omap_eac_s *s) |
... | ... | |
1591 | 1628 |
{ |
1592 | 1629 |
audsettings_t fmt; |
1593 | 1630 |
|
1594 |
omap_eac_out_empty(s); |
|
1631 |
/* The hardware buffers at most one sample */ |
|
1632 |
if (s->codec.rxlen) |
|
1633 |
s->codec.rxlen = 1; |
|
1595 | 1634 |
|
1596 | 1635 |
if (s->codec.in_voice) { |
1597 | 1636 |
AUD_set_active_in(s->codec.in_voice, 0); |
... | ... | |
1599 | 1638 |
s->codec.in_voice = 0; |
1600 | 1639 |
} |
1601 | 1640 |
if (s->codec.out_voice) { |
1641 |
omap_eac_out_empty(s); |
|
1602 | 1642 |
AUD_set_active_out(s->codec.out_voice, 0); |
1603 | 1643 |
AUD_close_out(&s->codec.card, s->codec.out_voice); |
1604 | 1644 |
s->codec.out_voice = 0; |
1645 |
s->codec.txavail = 0; |
|
1605 | 1646 |
} |
1647 |
/* Discard what couldn't be written */ |
|
1648 |
s->codec.txlen = 0; |
|
1606 | 1649 |
|
1607 | 1650 |
omap_eac_enable_update(s); |
1608 | 1651 |
if (!s->codec.enable) |
... | ... | |
1663 | 1706 |
s->codec.config[1] = 0x0000; |
1664 | 1707 |
s->codec.config[2] = 0x0007; |
1665 | 1708 |
s->codec.config[3] = 0x1ffc; |
1709 |
s->codec.rxoff = 0; |
|
1666 | 1710 |
s->codec.rxlen = 0; |
1667 | 1711 |
s->codec.txlen = 0; |
1668 | 1712 |
s->codec.rxavail = 0; |
... | ... | |
1676 | 1720 |
{ |
1677 | 1721 |
struct omap_eac_s *s = (struct omap_eac_s *) opaque; |
1678 | 1722 |
int offset = addr - s->base; |
1723 |
uint32_t ret; |
|
1679 | 1724 |
|
1680 | 1725 |
switch (offset) { |
1681 | 1726 |
case 0x000: /* CPCFR1 */ |
... | ... | |
1739 | 1784 |
/* This should be write-only? Docs list it as read-only. */ |
1740 | 1785 |
return 0x0000; |
1741 | 1786 |
case 0x0b8: /* ADRDR */ |
1742 |
if (likely(s->codec.rxlen > 1)) |
|
1743 |
return s->codec.rxbuf[EAC_BUF_LEN - s->codec.rxlen --]; |
|
1744 |
else if (s->codec.rxlen) { |
|
1787 |
if (likely(s->codec.rxlen > 1)) { |
|
1788 |
ret = s->codec.rxbuf[s->codec.rxoff ++]; |
|
1789 |
s->codec.rxlen --; |
|
1790 |
s->codec.rxoff &= EAC_BUF_LEN - 1; |
|
1791 |
return ret; |
|
1792 |
} else if (s->codec.rxlen) { |
|
1793 |
ret = s->codec.rxbuf[s->codec.rxoff ++]; |
|
1794 |
s->codec.rxlen --; |
|
1795 |
s->codec.rxoff &= EAC_BUF_LEN - 1; |
|
1745 | 1796 |
if (s->codec.rxavail) |
1746 | 1797 |
omap_eac_in_refill(s); |
1747 |
else { |
|
1748 |
s->codec.rxlen = 0; |
|
1749 |
omap_eac_in_dmarequest_update(s); |
|
1750 |
} |
|
1751 |
return s->codec.rxbuf[EAC_BUF_LEN - 1]; |
|
1798 |
omap_eac_in_dmarequest_update(s); |
|
1799 |
return ret; |
|
1752 | 1800 |
} |
1753 | 1801 |
return 0x0000; |
1754 | 1802 |
case 0x0bc: /* AGCFR */ |
... | ... | |
1881 | 1929 |
s->codec.txlen == s->codec.txavail)) { |
1882 | 1930 |
if (s->codec.txavail) |
1883 | 1931 |
omap_eac_out_empty(s); |
1884 |
else
|
|
1885 |
s->codec.txlen = 0;
|
|
1932 |
/* Discard what couldn't be written */
|
|
1933 |
s->codec.txlen = 0; |
|
1886 | 1934 |
} |
1887 | 1935 |
break; |
1888 | 1936 |
|
Also available in: Unified diff