.. | .. |
---|
25 | 25 | #include <linux/elf.h> |
---|
26 | 26 | #include <linux/tracehook.h> |
---|
27 | 27 | |
---|
28 | | -#include <asm/pgtable.h> |
---|
29 | 28 | #include <asm/processor.h> |
---|
30 | 29 | #include <asm/ptrace_offsets.h> |
---|
31 | 30 | #include <asm/rse.h> |
---|
32 | 31 | #include <linux/uaccess.h> |
---|
33 | 32 | #include <asm/unwind.h> |
---|
34 | | -#ifdef CONFIG_PERFMON |
---|
35 | | -#include <asm/perfmon.h> |
---|
36 | | -#endif |
---|
37 | 33 | |
---|
38 | 34 | #include "entry.h" |
---|
39 | 35 | |
---|
.. | .. |
---|
836 | 832 | char nat = 0; |
---|
837 | 833 | int i; |
---|
838 | 834 | |
---|
839 | | - if (!access_ok(VERIFY_WRITE, ppr, sizeof(struct pt_all_user_regs))) |
---|
| 835 | + if (!access_ok(ppr, sizeof(struct pt_all_user_regs))) |
---|
840 | 836 | return -EIO; |
---|
841 | 837 | |
---|
842 | 838 | pt = task_pt_regs(child); |
---|
.. | .. |
---|
981 | 977 | |
---|
982 | 978 | memset(&fpval, 0, sizeof(fpval)); |
---|
983 | 979 | |
---|
984 | | - if (!access_ok(VERIFY_READ, ppr, sizeof(struct pt_all_user_regs))) |
---|
| 980 | + if (!access_ok(ppr, sizeof(struct pt_all_user_regs))) |
---|
985 | 981 | return -EIO; |
---|
986 | 982 | |
---|
987 | 983 | pt = task_pt_regs(child); |
---|
.. | .. |
---|
1274 | 1270 | int ret; |
---|
1275 | 1271 | }; |
---|
1276 | 1272 | |
---|
| 1273 | +static const ptrdiff_t pt_offsets[32] = |
---|
| 1274 | +{ |
---|
| 1275 | +#define R(n) offsetof(struct pt_regs, r##n) |
---|
| 1276 | + [0] = -1, R(1), R(2), R(3), |
---|
| 1277 | + [4] = -1, [5] = -1, [6] = -1, [7] = -1, |
---|
| 1278 | + R(8), R(9), R(10), R(11), R(12), R(13), R(14), R(15), |
---|
| 1279 | + R(16), R(17), R(18), R(19), R(20), R(21), R(22), R(23), |
---|
| 1280 | + R(24), R(25), R(26), R(27), R(28), R(29), R(30), R(31), |
---|
| 1281 | +#undef R |
---|
| 1282 | +}; |
---|
| 1283 | + |
---|
1277 | 1284 | static int |
---|
1278 | 1285 | access_elf_gpreg(struct task_struct *target, struct unw_frame_info *info, |
---|
1279 | 1286 | unsigned long addr, unsigned long *data, int write_access) |
---|
1280 | 1287 | { |
---|
1281 | | - struct pt_regs *pt; |
---|
1282 | | - unsigned long *ptr = NULL; |
---|
1283 | | - int ret; |
---|
1284 | | - char nat = 0; |
---|
| 1288 | + struct pt_regs *pt = task_pt_regs(target); |
---|
| 1289 | + unsigned reg = addr / sizeof(unsigned long); |
---|
| 1290 | + ptrdiff_t d = pt_offsets[reg]; |
---|
1285 | 1291 | |
---|
1286 | | - pt = task_pt_regs(target); |
---|
1287 | | - switch (addr) { |
---|
1288 | | - case ELF_GR_OFFSET(1): |
---|
1289 | | - ptr = &pt->r1; |
---|
1290 | | - break; |
---|
1291 | | - case ELF_GR_OFFSET(2): |
---|
1292 | | - case ELF_GR_OFFSET(3): |
---|
1293 | | - ptr = (void *)&pt->r2 + (addr - ELF_GR_OFFSET(2)); |
---|
1294 | | - break; |
---|
1295 | | - case ELF_GR_OFFSET(4) ... ELF_GR_OFFSET(7): |
---|
| 1292 | + if (d >= 0) { |
---|
| 1293 | + unsigned long *ptr = (void *)pt + d; |
---|
| 1294 | + if (write_access) |
---|
| 1295 | + *ptr = *data; |
---|
| 1296 | + else |
---|
| 1297 | + *data = *ptr; |
---|
| 1298 | + return 0; |
---|
| 1299 | + } else { |
---|
| 1300 | + char nat = 0; |
---|
1296 | 1301 | if (write_access) { |
---|
1297 | 1302 | /* read NaT bit first: */ |
---|
1298 | 1303 | unsigned long dummy; |
---|
1299 | | - |
---|
1300 | | - ret = unw_get_gr(info, addr/8, &dummy, &nat); |
---|
| 1304 | + int ret = unw_get_gr(info, reg, &dummy, &nat); |
---|
1301 | 1305 | if (ret < 0) |
---|
1302 | 1306 | return ret; |
---|
1303 | 1307 | } |
---|
1304 | | - return unw_access_gr(info, addr/8, data, &nat, write_access); |
---|
1305 | | - case ELF_GR_OFFSET(8) ... ELF_GR_OFFSET(11): |
---|
1306 | | - ptr = (void *)&pt->r8 + addr - ELF_GR_OFFSET(8); |
---|
1307 | | - break; |
---|
1308 | | - case ELF_GR_OFFSET(12): |
---|
1309 | | - case ELF_GR_OFFSET(13): |
---|
1310 | | - ptr = (void *)&pt->r12 + addr - ELF_GR_OFFSET(12); |
---|
1311 | | - break; |
---|
1312 | | - case ELF_GR_OFFSET(14): |
---|
1313 | | - ptr = &pt->r14; |
---|
1314 | | - break; |
---|
1315 | | - case ELF_GR_OFFSET(15): |
---|
1316 | | - ptr = &pt->r15; |
---|
| 1308 | + return unw_access_gr(info, reg, data, &nat, write_access); |
---|
1317 | 1309 | } |
---|
1318 | | - if (write_access) |
---|
1319 | | - *ptr = *data; |
---|
1320 | | - else |
---|
1321 | | - *data = *ptr; |
---|
1322 | | - return 0; |
---|
1323 | 1310 | } |
---|
1324 | 1311 | |
---|
1325 | 1312 | static int |
---|
.. | .. |
---|
1491 | 1478 | access_elf_reg(struct task_struct *target, struct unw_frame_info *info, |
---|
1492 | 1479 | unsigned long addr, unsigned long *data, int write_access) |
---|
1493 | 1480 | { |
---|
1494 | | - if (addr >= ELF_GR_OFFSET(1) && addr <= ELF_GR_OFFSET(15)) |
---|
| 1481 | + if (addr >= ELF_GR_OFFSET(1) && addr <= ELF_GR_OFFSET(31)) |
---|
1495 | 1482 | return access_elf_gpreg(target, info, addr, data, write_access); |
---|
1496 | 1483 | else if (addr >= ELF_BR_OFFSET(0) && addr <= ELF_BR_OFFSET(7)) |
---|
1497 | 1484 | return access_elf_breg(target, info, addr, data, write_access); |
---|
.. | .. |
---|
1499 | 1486 | return access_elf_areg(target, info, addr, data, write_access); |
---|
1500 | 1487 | } |
---|
1501 | 1488 | |
---|
| 1489 | +struct regset_membuf { |
---|
| 1490 | + struct membuf to; |
---|
| 1491 | + int ret; |
---|
| 1492 | +}; |
---|
| 1493 | + |
---|
1502 | 1494 | void do_gpregs_get(struct unw_frame_info *info, void *arg) |
---|
1503 | 1495 | { |
---|
1504 | | - struct pt_regs *pt; |
---|
1505 | | - struct regset_getset *dst = arg; |
---|
1506 | | - elf_greg_t tmp[16]; |
---|
1507 | | - unsigned int i, index, min_copy; |
---|
| 1496 | + struct regset_membuf *dst = arg; |
---|
| 1497 | + struct membuf to = dst->to; |
---|
| 1498 | + unsigned int n; |
---|
| 1499 | + elf_greg_t reg; |
---|
1508 | 1500 | |
---|
1509 | 1501 | if (unw_unwind_to_user(info) < 0) |
---|
1510 | 1502 | return; |
---|
.. | .. |
---|
1522 | 1514 | |
---|
1523 | 1515 | |
---|
1524 | 1516 | /* Skip r0 */ |
---|
1525 | | - if (dst->count > 0 && dst->pos < ELF_GR_OFFSET(1)) { |
---|
1526 | | - dst->ret = user_regset_copyout_zero(&dst->pos, &dst->count, |
---|
1527 | | - &dst->u.get.kbuf, |
---|
1528 | | - &dst->u.get.ubuf, |
---|
1529 | | - 0, ELF_GR_OFFSET(1)); |
---|
1530 | | - if (dst->ret || dst->count == 0) |
---|
| 1517 | + membuf_zero(&to, 8); |
---|
| 1518 | + for (n = 8; to.left && n < ELF_AR_END_OFFSET; n += 8) { |
---|
| 1519 | + if (access_elf_reg(info->task, info, n, ®, 0) < 0) { |
---|
| 1520 | + dst->ret = -EIO; |
---|
1531 | 1521 | return; |
---|
1532 | | - } |
---|
1533 | | - |
---|
1534 | | - /* gr1 - gr15 */ |
---|
1535 | | - if (dst->count > 0 && dst->pos < ELF_GR_OFFSET(16)) { |
---|
1536 | | - index = (dst->pos - ELF_GR_OFFSET(1)) / sizeof(elf_greg_t); |
---|
1537 | | - min_copy = ELF_GR_OFFSET(16) > (dst->pos + dst->count) ? |
---|
1538 | | - (dst->pos + dst->count) : ELF_GR_OFFSET(16); |
---|
1539 | | - for (i = dst->pos; i < min_copy; i += sizeof(elf_greg_t), |
---|
1540 | | - index++) |
---|
1541 | | - if (access_elf_reg(dst->target, info, i, |
---|
1542 | | - &tmp[index], 0) < 0) { |
---|
1543 | | - dst->ret = -EIO; |
---|
1544 | | - return; |
---|
1545 | | - } |
---|
1546 | | - dst->ret = user_regset_copyout(&dst->pos, &dst->count, |
---|
1547 | | - &dst->u.get.kbuf, &dst->u.get.ubuf, tmp, |
---|
1548 | | - ELF_GR_OFFSET(1), ELF_GR_OFFSET(16)); |
---|
1549 | | - if (dst->ret || dst->count == 0) |
---|
1550 | | - return; |
---|
1551 | | - } |
---|
1552 | | - |
---|
1553 | | - /* r16-r31 */ |
---|
1554 | | - if (dst->count > 0 && dst->pos < ELF_NAT_OFFSET) { |
---|
1555 | | - pt = task_pt_regs(dst->target); |
---|
1556 | | - dst->ret = user_regset_copyout(&dst->pos, &dst->count, |
---|
1557 | | - &dst->u.get.kbuf, &dst->u.get.ubuf, &pt->r16, |
---|
1558 | | - ELF_GR_OFFSET(16), ELF_NAT_OFFSET); |
---|
1559 | | - if (dst->ret || dst->count == 0) |
---|
1560 | | - return; |
---|
1561 | | - } |
---|
1562 | | - |
---|
1563 | | - /* nat, pr, b0 - b7 */ |
---|
1564 | | - if (dst->count > 0 && dst->pos < ELF_CR_IIP_OFFSET) { |
---|
1565 | | - index = (dst->pos - ELF_NAT_OFFSET) / sizeof(elf_greg_t); |
---|
1566 | | - min_copy = ELF_CR_IIP_OFFSET > (dst->pos + dst->count) ? |
---|
1567 | | - (dst->pos + dst->count) : ELF_CR_IIP_OFFSET; |
---|
1568 | | - for (i = dst->pos; i < min_copy; i += sizeof(elf_greg_t), |
---|
1569 | | - index++) |
---|
1570 | | - if (access_elf_reg(dst->target, info, i, |
---|
1571 | | - &tmp[index], 0) < 0) { |
---|
1572 | | - dst->ret = -EIO; |
---|
1573 | | - return; |
---|
1574 | | - } |
---|
1575 | | - dst->ret = user_regset_copyout(&dst->pos, &dst->count, |
---|
1576 | | - &dst->u.get.kbuf, &dst->u.get.ubuf, tmp, |
---|
1577 | | - ELF_NAT_OFFSET, ELF_CR_IIP_OFFSET); |
---|
1578 | | - if (dst->ret || dst->count == 0) |
---|
1579 | | - return; |
---|
1580 | | - } |
---|
1581 | | - |
---|
1582 | | - /* ip cfm psr ar.rsc ar.bsp ar.bspstore ar.rnat |
---|
1583 | | - * ar.ccv ar.unat ar.fpsr ar.pfs ar.lc ar.ec ar.csd ar.ssd |
---|
1584 | | - */ |
---|
1585 | | - if (dst->count > 0 && dst->pos < (ELF_AR_END_OFFSET)) { |
---|
1586 | | - index = (dst->pos - ELF_CR_IIP_OFFSET) / sizeof(elf_greg_t); |
---|
1587 | | - min_copy = ELF_AR_END_OFFSET > (dst->pos + dst->count) ? |
---|
1588 | | - (dst->pos + dst->count) : ELF_AR_END_OFFSET; |
---|
1589 | | - for (i = dst->pos; i < min_copy; i += sizeof(elf_greg_t), |
---|
1590 | | - index++) |
---|
1591 | | - if (access_elf_reg(dst->target, info, i, |
---|
1592 | | - &tmp[index], 0) < 0) { |
---|
1593 | | - dst->ret = -EIO; |
---|
1594 | | - return; |
---|
1595 | | - } |
---|
1596 | | - dst->ret = user_regset_copyout(&dst->pos, &dst->count, |
---|
1597 | | - &dst->u.get.kbuf, &dst->u.get.ubuf, tmp, |
---|
1598 | | - ELF_CR_IIP_OFFSET, ELF_AR_END_OFFSET); |
---|
| 1522 | + } |
---|
| 1523 | + membuf_store(&to, reg); |
---|
1599 | 1524 | } |
---|
1600 | 1525 | } |
---|
1601 | 1526 | |
---|
1602 | 1527 | void do_gpregs_set(struct unw_frame_info *info, void *arg) |
---|
1603 | 1528 | { |
---|
1604 | | - struct pt_regs *pt; |
---|
1605 | 1529 | struct regset_getset *dst = arg; |
---|
1606 | | - elf_greg_t tmp[16]; |
---|
1607 | | - unsigned int i, index; |
---|
1608 | 1530 | |
---|
1609 | 1531 | if (unw_unwind_to_user(info) < 0) |
---|
1610 | 1532 | return; |
---|
1611 | 1533 | |
---|
| 1534 | + if (!dst->count) |
---|
| 1535 | + return; |
---|
1612 | 1536 | /* Skip r0 */ |
---|
1613 | | - if (dst->count > 0 && dst->pos < ELF_GR_OFFSET(1)) { |
---|
| 1537 | + if (dst->pos < ELF_GR_OFFSET(1)) { |
---|
1614 | 1538 | dst->ret = user_regset_copyin_ignore(&dst->pos, &dst->count, |
---|
1615 | 1539 | &dst->u.set.kbuf, |
---|
1616 | 1540 | &dst->u.set.ubuf, |
---|
1617 | 1541 | 0, ELF_GR_OFFSET(1)); |
---|
1618 | | - if (dst->ret || dst->count == 0) |
---|
1619 | | - return; |
---|
1620 | | - } |
---|
1621 | | - |
---|
1622 | | - /* gr1-gr15 */ |
---|
1623 | | - if (dst->count > 0 && dst->pos < ELF_GR_OFFSET(16)) { |
---|
1624 | | - i = dst->pos; |
---|
1625 | | - index = (dst->pos - ELF_GR_OFFSET(1)) / sizeof(elf_greg_t); |
---|
1626 | | - dst->ret = user_regset_copyin(&dst->pos, &dst->count, |
---|
1627 | | - &dst->u.set.kbuf, &dst->u.set.ubuf, tmp, |
---|
1628 | | - ELF_GR_OFFSET(1), ELF_GR_OFFSET(16)); |
---|
1629 | 1542 | if (dst->ret) |
---|
1630 | 1543 | return; |
---|
1631 | | - for ( ; i < dst->pos; i += sizeof(elf_greg_t), index++) |
---|
1632 | | - if (access_elf_reg(dst->target, info, i, |
---|
1633 | | - &tmp[index], 1) < 0) { |
---|
1634 | | - dst->ret = -EIO; |
---|
1635 | | - return; |
---|
1636 | | - } |
---|
1637 | | - if (dst->count == 0) |
---|
1638 | | - return; |
---|
1639 | 1544 | } |
---|
1640 | 1545 | |
---|
1641 | | - /* gr16-gr31 */ |
---|
1642 | | - if (dst->count > 0 && dst->pos < ELF_NAT_OFFSET) { |
---|
1643 | | - pt = task_pt_regs(dst->target); |
---|
1644 | | - dst->ret = user_regset_copyin(&dst->pos, &dst->count, |
---|
1645 | | - &dst->u.set.kbuf, &dst->u.set.ubuf, &pt->r16, |
---|
1646 | | - ELF_GR_OFFSET(16), ELF_NAT_OFFSET); |
---|
1647 | | - if (dst->ret || dst->count == 0) |
---|
1648 | | - return; |
---|
1649 | | - } |
---|
| 1546 | + while (dst->count && dst->pos < ELF_AR_END_OFFSET) { |
---|
| 1547 | + unsigned int n, from, to; |
---|
| 1548 | + elf_greg_t tmp[16]; |
---|
1650 | 1549 | |
---|
1651 | | - /* nat, pr, b0 - b7 */ |
---|
1652 | | - if (dst->count > 0 && dst->pos < ELF_CR_IIP_OFFSET) { |
---|
1653 | | - i = dst->pos; |
---|
1654 | | - index = (dst->pos - ELF_NAT_OFFSET) / sizeof(elf_greg_t); |
---|
| 1550 | + from = dst->pos; |
---|
| 1551 | + to = from + sizeof(tmp); |
---|
| 1552 | + if (to > ELF_AR_END_OFFSET) |
---|
| 1553 | + to = ELF_AR_END_OFFSET; |
---|
| 1554 | + /* get up to 16 values */ |
---|
1655 | 1555 | dst->ret = user_regset_copyin(&dst->pos, &dst->count, |
---|
1656 | 1556 | &dst->u.set.kbuf, &dst->u.set.ubuf, tmp, |
---|
1657 | | - ELF_NAT_OFFSET, ELF_CR_IIP_OFFSET); |
---|
| 1557 | + from, to); |
---|
1658 | 1558 | if (dst->ret) |
---|
1659 | 1559 | return; |
---|
1660 | | - for (; i < dst->pos; i += sizeof(elf_greg_t), index++) |
---|
1661 | | - if (access_elf_reg(dst->target, info, i, |
---|
1662 | | - &tmp[index], 1) < 0) { |
---|
1663 | | - dst->ret = -EIO; |
---|
1664 | | - return; |
---|
1665 | | - } |
---|
1666 | | - if (dst->count == 0) |
---|
1667 | | - return; |
---|
1668 | | - } |
---|
1669 | | - |
---|
1670 | | - /* ip cfm psr ar.rsc ar.bsp ar.bspstore ar.rnat |
---|
1671 | | - * ar.ccv ar.unat ar.fpsr ar.pfs ar.lc ar.ec ar.csd ar.ssd |
---|
1672 | | - */ |
---|
1673 | | - if (dst->count > 0 && dst->pos < (ELF_AR_END_OFFSET)) { |
---|
1674 | | - i = dst->pos; |
---|
1675 | | - index = (dst->pos - ELF_CR_IIP_OFFSET) / sizeof(elf_greg_t); |
---|
1676 | | - dst->ret = user_regset_copyin(&dst->pos, &dst->count, |
---|
1677 | | - &dst->u.set.kbuf, &dst->u.set.ubuf, tmp, |
---|
1678 | | - ELF_CR_IIP_OFFSET, ELF_AR_END_OFFSET); |
---|
1679 | | - if (dst->ret) |
---|
1680 | | - return; |
---|
1681 | | - for ( ; i < dst->pos; i += sizeof(elf_greg_t), index++) |
---|
1682 | | - if (access_elf_reg(dst->target, info, i, |
---|
1683 | | - &tmp[index], 1) < 0) { |
---|
| 1560 | + /* now copy them into registers */ |
---|
| 1561 | + for (n = 0; from < dst->pos; from += sizeof(elf_greg_t), n++) |
---|
| 1562 | + if (access_elf_reg(dst->target, info, from, |
---|
| 1563 | + &tmp[n], 1) < 0) { |
---|
1684 | 1564 | dst->ret = -EIO; |
---|
1685 | 1565 | return; |
---|
1686 | 1566 | } |
---|
.. | .. |
---|
1691 | 1571 | |
---|
1692 | 1572 | void do_fpregs_get(struct unw_frame_info *info, void *arg) |
---|
1693 | 1573 | { |
---|
1694 | | - struct regset_getset *dst = arg; |
---|
1695 | | - struct task_struct *task = dst->target; |
---|
1696 | | - elf_fpreg_t tmp[30]; |
---|
1697 | | - int index, min_copy, i; |
---|
| 1574 | + struct task_struct *task = info->task; |
---|
| 1575 | + struct regset_membuf *dst = arg; |
---|
| 1576 | + struct membuf to = dst->to; |
---|
| 1577 | + elf_fpreg_t reg; |
---|
| 1578 | + unsigned int n; |
---|
1698 | 1579 | |
---|
1699 | 1580 | if (unw_unwind_to_user(info) < 0) |
---|
1700 | 1581 | return; |
---|
1701 | 1582 | |
---|
1702 | 1583 | /* Skip pos 0 and 1 */ |
---|
1703 | | - if (dst->count > 0 && dst->pos < ELF_FP_OFFSET(2)) { |
---|
1704 | | - dst->ret = user_regset_copyout_zero(&dst->pos, &dst->count, |
---|
1705 | | - &dst->u.get.kbuf, |
---|
1706 | | - &dst->u.get.ubuf, |
---|
1707 | | - 0, ELF_FP_OFFSET(2)); |
---|
1708 | | - if (dst->count == 0 || dst->ret) |
---|
1709 | | - return; |
---|
1710 | | - } |
---|
| 1584 | + membuf_zero(&to, 2 * sizeof(elf_fpreg_t)); |
---|
1711 | 1585 | |
---|
1712 | 1586 | /* fr2-fr31 */ |
---|
1713 | | - if (dst->count > 0 && dst->pos < ELF_FP_OFFSET(32)) { |
---|
1714 | | - index = (dst->pos - ELF_FP_OFFSET(2)) / sizeof(elf_fpreg_t); |
---|
1715 | | - |
---|
1716 | | - min_copy = min(((unsigned int)ELF_FP_OFFSET(32)), |
---|
1717 | | - dst->pos + dst->count); |
---|
1718 | | - for (i = dst->pos; i < min_copy; i += sizeof(elf_fpreg_t), |
---|
1719 | | - index++) |
---|
1720 | | - if (unw_get_fr(info, i / sizeof(elf_fpreg_t), |
---|
1721 | | - &tmp[index])) { |
---|
1722 | | - dst->ret = -EIO; |
---|
1723 | | - return; |
---|
1724 | | - } |
---|
1725 | | - dst->ret = user_regset_copyout(&dst->pos, &dst->count, |
---|
1726 | | - &dst->u.get.kbuf, &dst->u.get.ubuf, tmp, |
---|
1727 | | - ELF_FP_OFFSET(2), ELF_FP_OFFSET(32)); |
---|
1728 | | - if (dst->count == 0 || dst->ret) |
---|
| 1587 | + for (n = 2; to.left && n < 32; n++) { |
---|
| 1588 | + if (unw_get_fr(info, n, ®)) { |
---|
| 1589 | + dst->ret = -EIO; |
---|
1729 | 1590 | return; |
---|
| 1591 | + } |
---|
| 1592 | + membuf_write(&to, ®, sizeof(reg)); |
---|
1730 | 1593 | } |
---|
1731 | 1594 | |
---|
1732 | 1595 | /* fph */ |
---|
1733 | | - if (dst->count > 0) { |
---|
1734 | | - ia64_flush_fph(dst->target); |
---|
1735 | | - if (task->thread.flags & IA64_THREAD_FPH_VALID) |
---|
1736 | | - dst->ret = user_regset_copyout( |
---|
1737 | | - &dst->pos, &dst->count, |
---|
1738 | | - &dst->u.get.kbuf, &dst->u.get.ubuf, |
---|
1739 | | - &dst->target->thread.fph, |
---|
1740 | | - ELF_FP_OFFSET(32), -1); |
---|
1741 | | - else |
---|
1742 | | - /* Zero fill instead. */ |
---|
1743 | | - dst->ret = user_regset_copyout_zero( |
---|
1744 | | - &dst->pos, &dst->count, |
---|
1745 | | - &dst->u.get.kbuf, &dst->u.get.ubuf, |
---|
1746 | | - ELF_FP_OFFSET(32), -1); |
---|
1747 | | - } |
---|
| 1596 | + if (!to.left) |
---|
| 1597 | + return; |
---|
| 1598 | + |
---|
| 1599 | + ia64_flush_fph(task); |
---|
| 1600 | + if (task->thread.flags & IA64_THREAD_FPH_VALID) |
---|
| 1601 | + membuf_write(&to, &task->thread.fph, 96 * sizeof(reg)); |
---|
| 1602 | + else |
---|
| 1603 | + membuf_zero(&to, 96 * sizeof(reg)); |
---|
1748 | 1604 | } |
---|
1749 | 1605 | |
---|
1750 | 1606 | void do_fpregs_set(struct unw_frame_info *info, void *arg) |
---|
.. | .. |
---|
1820 | 1676 | } |
---|
1821 | 1677 | } |
---|
1822 | 1678 | |
---|
| 1679 | +static void |
---|
| 1680 | +unwind_and_call(void (*call)(struct unw_frame_info *, void *), |
---|
| 1681 | + struct task_struct *target, void *data) |
---|
| 1682 | +{ |
---|
| 1683 | + if (target == current) |
---|
| 1684 | + unw_init_running(call, data); |
---|
| 1685 | + else { |
---|
| 1686 | + struct unw_frame_info info; |
---|
| 1687 | + memset(&info, 0, sizeof(info)); |
---|
| 1688 | + unw_init_from_blocked_task(&info, target); |
---|
| 1689 | + (*call)(&info, data); |
---|
| 1690 | + } |
---|
| 1691 | +} |
---|
| 1692 | + |
---|
1823 | 1693 | static int |
---|
1824 | 1694 | do_regset_call(void (*call)(struct unw_frame_info *, void *), |
---|
1825 | 1695 | struct task_struct *target, |
---|
.. | .. |
---|
1831 | 1701 | .pos = pos, .count = count, |
---|
1832 | 1702 | .u.set = { .kbuf = kbuf, .ubuf = ubuf }, |
---|
1833 | 1703 | .ret = 0 }; |
---|
1834 | | - |
---|
1835 | | - if (target == current) |
---|
1836 | | - unw_init_running(call, &info); |
---|
1837 | | - else { |
---|
1838 | | - struct unw_frame_info ufi; |
---|
1839 | | - memset(&ufi, 0, sizeof(ufi)); |
---|
1840 | | - unw_init_from_blocked_task(&ufi, target); |
---|
1841 | | - (*call)(&ufi, &info); |
---|
1842 | | - } |
---|
1843 | | - |
---|
| 1704 | + unwind_and_call(call, target, &info); |
---|
1844 | 1705 | return info.ret; |
---|
1845 | 1706 | } |
---|
1846 | 1707 | |
---|
1847 | 1708 | static int |
---|
1848 | 1709 | gpregs_get(struct task_struct *target, |
---|
1849 | 1710 | const struct user_regset *regset, |
---|
1850 | | - unsigned int pos, unsigned int count, |
---|
1851 | | - void *kbuf, void __user *ubuf) |
---|
| 1711 | + struct membuf to) |
---|
1852 | 1712 | { |
---|
1853 | | - return do_regset_call(do_gpregs_get, target, regset, pos, count, |
---|
1854 | | - kbuf, ubuf); |
---|
| 1713 | + struct regset_membuf info = {.to = to}; |
---|
| 1714 | + unwind_and_call(do_gpregs_get, target, &info); |
---|
| 1715 | + return info.ret; |
---|
1855 | 1716 | } |
---|
1856 | 1717 | |
---|
1857 | 1718 | static int gpregs_set(struct task_struct *target, |
---|
.. | .. |
---|
1893 | 1754 | |
---|
1894 | 1755 | static int fpregs_get(struct task_struct *target, |
---|
1895 | 1756 | const struct user_regset *regset, |
---|
1896 | | - unsigned int pos, unsigned int count, |
---|
1897 | | - void *kbuf, void __user *ubuf) |
---|
| 1757 | + struct membuf to) |
---|
1898 | 1758 | { |
---|
1899 | | - return do_regset_call(do_fpregs_get, target, regset, pos, count, |
---|
1900 | | - kbuf, ubuf); |
---|
| 1759 | + struct regset_membuf info = {.to = to}; |
---|
| 1760 | + unwind_and_call(do_fpregs_get, target, &info); |
---|
| 1761 | + return info.ret; |
---|
1901 | 1762 | } |
---|
1902 | 1763 | |
---|
1903 | 1764 | static int fpregs_set(struct task_struct *target, |
---|
.. | .. |
---|
1914 | 1775 | unsigned long *data, int write_access) |
---|
1915 | 1776 | { |
---|
1916 | 1777 | unsigned int pos = -1; /* an invalid value */ |
---|
1917 | | - int ret; |
---|
1918 | 1778 | unsigned long *ptr, regnum; |
---|
1919 | 1779 | |
---|
1920 | 1780 | if ((addr & 0x7) != 0) { |
---|
.. | .. |
---|
1946 | 1806 | } |
---|
1947 | 1807 | |
---|
1948 | 1808 | if (pos != -1) { |
---|
1949 | | - if (write_access) |
---|
1950 | | - ret = fpregs_set(child, NULL, pos, |
---|
1951 | | - sizeof(unsigned long), data, NULL); |
---|
1952 | | - else |
---|
1953 | | - ret = fpregs_get(child, NULL, pos, |
---|
1954 | | - sizeof(unsigned long), data, NULL); |
---|
1955 | | - if (ret != 0) |
---|
1956 | | - return -1; |
---|
| 1809 | + unsigned reg = pos / sizeof(elf_fpreg_t); |
---|
| 1810 | + int which_half = (pos / sizeof(unsigned long)) & 1; |
---|
| 1811 | + |
---|
| 1812 | + if (reg < 32) { /* fr2-fr31 */ |
---|
| 1813 | + struct unw_frame_info info; |
---|
| 1814 | + elf_fpreg_t fpreg; |
---|
| 1815 | + |
---|
| 1816 | + memset(&info, 0, sizeof(info)); |
---|
| 1817 | + unw_init_from_blocked_task(&info, child); |
---|
| 1818 | + if (unw_unwind_to_user(&info) < 0) |
---|
| 1819 | + return 0; |
---|
| 1820 | + |
---|
| 1821 | + if (unw_get_fr(&info, reg, &fpreg)) |
---|
| 1822 | + return -1; |
---|
| 1823 | + if (write_access) { |
---|
| 1824 | + fpreg.u.bits[which_half] = *data; |
---|
| 1825 | + if (unw_set_fr(&info, reg, fpreg)) |
---|
| 1826 | + return -1; |
---|
| 1827 | + } else { |
---|
| 1828 | + *data = fpreg.u.bits[which_half]; |
---|
| 1829 | + } |
---|
| 1830 | + } else { /* fph */ |
---|
| 1831 | + elf_fpreg_t *p = &child->thread.fph[reg - 32]; |
---|
| 1832 | + unsigned long *bits = &p->u.bits[which_half]; |
---|
| 1833 | + |
---|
| 1834 | + ia64_sync_fph(child); |
---|
| 1835 | + if (write_access) |
---|
| 1836 | + *bits = *data; |
---|
| 1837 | + else if (child->thread.flags & IA64_THREAD_FPH_VALID) |
---|
| 1838 | + *data = *bits; |
---|
| 1839 | + else |
---|
| 1840 | + *data = 0; |
---|
| 1841 | + } |
---|
1957 | 1842 | return 0; |
---|
1958 | 1843 | } |
---|
1959 | 1844 | |
---|
.. | .. |
---|
2039 | 1924 | } |
---|
2040 | 1925 | |
---|
2041 | 1926 | if (pos != -1) { |
---|
2042 | | - if (write_access) |
---|
2043 | | - ret = gpregs_set(child, NULL, pos, |
---|
2044 | | - sizeof(unsigned long), data, NULL); |
---|
2045 | | - else |
---|
2046 | | - ret = gpregs_get(child, NULL, pos, |
---|
2047 | | - sizeof(unsigned long), data, NULL); |
---|
2048 | | - if (ret != 0) |
---|
2049 | | - return -1; |
---|
2050 | | - return 0; |
---|
| 1927 | + struct unw_frame_info info; |
---|
| 1928 | + |
---|
| 1929 | + memset(&info, 0, sizeof(info)); |
---|
| 1930 | + unw_init_from_blocked_task(&info, child); |
---|
| 1931 | + if (unw_unwind_to_user(&info) < 0) |
---|
| 1932 | + return 0; |
---|
| 1933 | + |
---|
| 1934 | + return access_elf_reg(child, &info, pos, data, write_access); |
---|
2051 | 1935 | } |
---|
2052 | 1936 | |
---|
2053 | 1937 | /* access debug registers */ |
---|
.. | .. |
---|
2064 | 1948 | "address 0x%lx\n", addr); |
---|
2065 | 1949 | return -1; |
---|
2066 | 1950 | } |
---|
2067 | | -#ifdef CONFIG_PERFMON |
---|
2068 | | - /* |
---|
2069 | | - * Check if debug registers are used by perfmon. This |
---|
2070 | | - * test must be done once we know that we can do the |
---|
2071 | | - * operation, i.e. the arguments are all valid, but |
---|
2072 | | - * before we start modifying the state. |
---|
2073 | | - * |
---|
2074 | | - * Perfmon needs to keep a count of how many processes |
---|
2075 | | - * are trying to modify the debug registers for system |
---|
2076 | | - * wide monitoring sessions. |
---|
2077 | | - * |
---|
2078 | | - * We also include read access here, because they may |
---|
2079 | | - * cause the PMU-installed debug register state |
---|
2080 | | - * (dbr[], ibr[]) to be reset. The two arrays are also |
---|
2081 | | - * used by perfmon, but we do not use |
---|
2082 | | - * IA64_THREAD_DBG_VALID. The registers are restored |
---|
2083 | | - * by the PMU context switch code. |
---|
2084 | | - */ |
---|
2085 | | - if (pfm_use_debug_registers(child)) |
---|
2086 | | - return -1; |
---|
2087 | | -#endif |
---|
2088 | 1951 | |
---|
2089 | 1952 | if (!(child->thread.flags & IA64_THREAD_DBG_VALID)) { |
---|
2090 | 1953 | child->thread.flags |= IA64_THREAD_DBG_VALID; |
---|
.. | .. |
---|
2113 | 1976 | .core_note_type = NT_PRSTATUS, |
---|
2114 | 1977 | .n = ELF_NGREG, |
---|
2115 | 1978 | .size = sizeof(elf_greg_t), .align = sizeof(elf_greg_t), |
---|
2116 | | - .get = gpregs_get, .set = gpregs_set, |
---|
| 1979 | + .regset_get = gpregs_get, .set = gpregs_set, |
---|
2117 | 1980 | .writeback = gpregs_writeback |
---|
2118 | 1981 | }, |
---|
2119 | 1982 | { |
---|
2120 | 1983 | .core_note_type = NT_PRFPREG, |
---|
2121 | 1984 | .n = ELF_NFPREG, |
---|
2122 | 1985 | .size = sizeof(elf_fpreg_t), .align = sizeof(elf_fpreg_t), |
---|
2123 | | - .get = fpregs_get, .set = fpregs_set, .active = fpregs_active |
---|
| 1986 | + .regset_get = fpregs_get, .set = fpregs_set, .active = fpregs_active |
---|
2124 | 1987 | }, |
---|
2125 | 1988 | }; |
---|
2126 | 1989 | |
---|
.. | .. |
---|
2191 | 2054 | } |
---|
2192 | 2055 | |
---|
2193 | 2056 | void ia64_syscall_get_set_arguments(struct task_struct *task, |
---|
2194 | | - struct pt_regs *regs, unsigned int i, unsigned int n, |
---|
2195 | | - unsigned long *args, int rw) |
---|
| 2057 | + struct pt_regs *regs, unsigned long *args, int rw) |
---|
2196 | 2058 | { |
---|
2197 | 2059 | struct syscall_get_set_args data = { |
---|
2198 | | - .i = i, |
---|
2199 | | - .n = n, |
---|
| 2060 | + .i = 0, |
---|
| 2061 | + .n = 6, |
---|
2200 | 2062 | .args = args, |
---|
2201 | 2063 | .regs = regs, |
---|
2202 | 2064 | .rw = rw, |
---|