| .. | .. |
|---|
| 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, |
|---|