180814287SRaphael Isemann //===-- NativeRegisterContextLinux.cpp ------------------------------------===//
2068f8a7eSTamas Berghammer //
32946cd70SChandler Carruth // Part of the LLVM Project, under the Apache License v2.0 with LLVM Exceptions.
42946cd70SChandler Carruth // See https://llvm.org/LICENSE.txt for license information.
52946cd70SChandler Carruth // SPDX-License-Identifier: Apache-2.0 WITH LLVM-exception
6068f8a7eSTamas Berghammer //
7068f8a7eSTamas Berghammer //===----------------------------------------------------------------------===//
8068f8a7eSTamas Berghammer 
9068f8a7eSTamas Berghammer #include "NativeRegisterContextLinux.h"
10068f8a7eSTamas Berghammer 
11068f8a7eSTamas Berghammer #include "lldb/Host/common/NativeProcessProtocol.h"
12068f8a7eSTamas Berghammer #include "lldb/Host/common/NativeThreadProtocol.h"
13068f8a7eSTamas Berghammer #include "lldb/Host/linux/Ptrace.h"
14d821c997SPavel Labath #include "lldb/Utility/RegisterValue.h"
15068f8a7eSTamas Berghammer 
16d37349f3SPavel Labath #include "Plugins/Process/Linux/NativeProcessLinux.h"
17068f8a7eSTamas Berghammer #include "Plugins/Process/POSIX/ProcessPOSIXLog.h"
18068f8a7eSTamas Berghammer 
19068f8a7eSTamas Berghammer using namespace lldb_private;
20068f8a7eSTamas Berghammer using namespace lldb_private::process_linux;
21068f8a7eSTamas Berghammer 
GetByteOrder() const22b9c1b51eSKate Stone lldb::ByteOrder NativeRegisterContextLinux::GetByteOrder() const {
23578a4258SPavel Labath   return m_thread.GetProcess().GetByteOrder();
24068f8a7eSTamas Berghammer }
25068f8a7eSTamas Berghammer 
ReadRegisterRaw(uint32_t reg_index,RegisterValue & reg_value)2697206d57SZachary Turner Status NativeRegisterContextLinux::ReadRegisterRaw(uint32_t reg_index,
27b9c1b51eSKate Stone                                                    RegisterValue &reg_value) {
28068f8a7eSTamas Berghammer   const RegisterInfo *const reg_info = GetRegisterInfoAtIndex(reg_index);
29068f8a7eSTamas Berghammer   if (!reg_info)
3097206d57SZachary Turner     return Status("register %" PRIu32 " not found", reg_index);
31068f8a7eSTamas Berghammer 
32e46c6644SGuilherme Andrade   return DoReadRegisterValue(GetPtraceOffset(reg_index), reg_info->name,
33b9c1b51eSKate Stone                              reg_info->byte_size, reg_value);
34068f8a7eSTamas Berghammer }
35068f8a7eSTamas Berghammer 
3697206d57SZachary Turner Status
WriteRegisterRaw(uint32_t reg_index,const RegisterValue & reg_value)3797206d57SZachary Turner NativeRegisterContextLinux::WriteRegisterRaw(uint32_t reg_index,
3897206d57SZachary Turner                                              const RegisterValue &reg_value) {
39068f8a7eSTamas Berghammer   uint32_t reg_to_write = reg_index;
40068f8a7eSTamas Berghammer   RegisterValue value_to_write = reg_value;
41068f8a7eSTamas Berghammer 
42068f8a7eSTamas Berghammer   // Check if this is a subregister of a full register.
43068f8a7eSTamas Berghammer   const RegisterInfo *reg_info = GetRegisterInfoAtIndex(reg_index);
44b9c1b51eSKate Stone   if (reg_info->invalidate_regs &&
45b9c1b51eSKate Stone       (reg_info->invalidate_regs[0] != LLDB_INVALID_REGNUM)) {
4697206d57SZachary Turner     Status error;
47068f8a7eSTamas Berghammer 
48068f8a7eSTamas Berghammer     RegisterValue full_value;
49068f8a7eSTamas Berghammer     uint32_t full_reg = reg_info->invalidate_regs[0];
50068f8a7eSTamas Berghammer     const RegisterInfo *full_reg_info = GetRegisterInfoAtIndex(full_reg);
51068f8a7eSTamas Berghammer 
52068f8a7eSTamas Berghammer     // Read the full register.
53068f8a7eSTamas Berghammer     error = ReadRegister(full_reg_info, full_value);
54068f8a7eSTamas Berghammer     if (error.Fail())
55068f8a7eSTamas Berghammer       return error;
56068f8a7eSTamas Berghammer 
57068f8a7eSTamas Berghammer     lldb::ByteOrder byte_order = GetByteOrder();
58068f8a7eSTamas Berghammer     uint8_t dst[RegisterValue::kMaxRegisterByteSize];
59068f8a7eSTamas Berghammer 
60068f8a7eSTamas Berghammer     // Get the bytes for the full register.
61b9c1b51eSKate Stone     const uint32_t dest_size = full_value.GetAsMemoryData(
62b9c1b51eSKate Stone         full_reg_info, dst, sizeof(dst), byte_order, error);
63b9c1b51eSKate Stone     if (error.Success() && dest_size) {
64068f8a7eSTamas Berghammer       uint8_t src[RegisterValue::kMaxRegisterByteSize];
65068f8a7eSTamas Berghammer 
66068f8a7eSTamas Berghammer       // Get the bytes for the source data.
67b9c1b51eSKate Stone       const uint32_t src_size = reg_value.GetAsMemoryData(
68b9c1b51eSKate Stone           reg_info, src, sizeof(src), byte_order, error);
69b9c1b51eSKate Stone       if (error.Success() && src_size && (src_size < dest_size)) {
70068f8a7eSTamas Berghammer         // Copy the src bytes to the destination.
71068f8a7eSTamas Berghammer         memcpy(dst + (reg_info->byte_offset & 0x1), src, src_size);
72068f8a7eSTamas Berghammer         // Set this full register as the value to write.
73068f8a7eSTamas Berghammer         value_to_write.SetBytes(dst, full_value.GetByteSize(), byte_order);
74068f8a7eSTamas Berghammer         value_to_write.SetType(full_reg_info);
75068f8a7eSTamas Berghammer         reg_to_write = full_reg;
76068f8a7eSTamas Berghammer       }
77068f8a7eSTamas Berghammer     }
78068f8a7eSTamas Berghammer   }
79068f8a7eSTamas Berghammer 
80b9c1b51eSKate Stone   const RegisterInfo *const register_to_write_info_p =
81b9c1b51eSKate Stone       GetRegisterInfoAtIndex(reg_to_write);
82b9c1b51eSKate Stone   assert(register_to_write_info_p &&
83b9c1b51eSKate Stone          "register to write does not have valid RegisterInfo");
84068f8a7eSTamas Berghammer   if (!register_to_write_info_p)
8597206d57SZachary Turner     return Status("NativeRegisterContextLinux::%s failed to get RegisterInfo "
86b9c1b51eSKate Stone                   "for write register index %" PRIu32,
87b9c1b51eSKate Stone                   __FUNCTION__, reg_to_write);
88068f8a7eSTamas Berghammer 
89e46c6644SGuilherme Andrade   return DoWriteRegisterValue(GetPtraceOffset(reg_index), reg_info->name,
90e46c6644SGuilherme Andrade                               reg_value);
91068f8a7eSTamas Berghammer }
92068f8a7eSTamas Berghammer 
ReadGPR()9397206d57SZachary Turner Status NativeRegisterContextLinux::ReadGPR() {
943f3673eaSPavel Labath   return NativeProcessLinux::PtraceWrapper(
953f3673eaSPavel Labath       PTRACE_GETREGS, m_thread.GetID(), nullptr, GetGPRBuffer(), GetGPRSize());
96068f8a7eSTamas Berghammer }
97068f8a7eSTamas Berghammer 
WriteGPR()9897206d57SZachary Turner Status NativeRegisterContextLinux::WriteGPR() {
993f3673eaSPavel Labath   return NativeProcessLinux::PtraceWrapper(
1003f3673eaSPavel Labath       PTRACE_SETREGS, m_thread.GetID(), nullptr, GetGPRBuffer(), GetGPRSize());
101068f8a7eSTamas Berghammer }
102068f8a7eSTamas Berghammer 
ReadFPR()10397206d57SZachary Turner Status NativeRegisterContextLinux::ReadFPR() {
1043f3673eaSPavel Labath   return NativeProcessLinux::PtraceWrapper(PTRACE_GETFPREGS, m_thread.GetID(),
1053f3673eaSPavel Labath                                            nullptr, GetFPRBuffer(),
1063f3673eaSPavel Labath                                            GetFPRSize());
107068f8a7eSTamas Berghammer }
108068f8a7eSTamas Berghammer 
WriteFPR()10997206d57SZachary Turner Status NativeRegisterContextLinux::WriteFPR() {
1103f3673eaSPavel Labath   return NativeProcessLinux::PtraceWrapper(PTRACE_SETFPREGS, m_thread.GetID(),
1113f3673eaSPavel Labath                                            nullptr, GetFPRBuffer(),
1123f3673eaSPavel Labath                                            GetFPRSize());
113068f8a7eSTamas Berghammer }
114068f8a7eSTamas Berghammer 
ReadRegisterSet(void * buf,size_t buf_size,unsigned int regset)11597206d57SZachary Turner Status NativeRegisterContextLinux::ReadRegisterSet(void *buf, size_t buf_size,
116b9c1b51eSKate Stone                                                    unsigned int regset) {
1174a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(PTRACE_GETREGSET, m_thread.GetID(),
118b9c1b51eSKate Stone                                            static_cast<void *>(&regset), buf,
119b9c1b51eSKate Stone                                            buf_size);
120068f8a7eSTamas Berghammer }
121068f8a7eSTamas Berghammer 
WriteRegisterSet(void * buf,size_t buf_size,unsigned int regset)12297206d57SZachary Turner Status NativeRegisterContextLinux::WriteRegisterSet(void *buf, size_t buf_size,
123b9c1b51eSKate Stone                                                     unsigned int regset) {
1244a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(PTRACE_SETREGSET, m_thread.GetID(),
125b9c1b51eSKate Stone                                            static_cast<void *>(&regset), buf,
126b9c1b51eSKate Stone                                            buf_size);
127068f8a7eSTamas Berghammer }
128068f8a7eSTamas Berghammer 
DoReadRegisterValue(uint32_t offset,const char * reg_name,uint32_t size,RegisterValue & value)12997206d57SZachary Turner Status NativeRegisterContextLinux::DoReadRegisterValue(uint32_t offset,
130068f8a7eSTamas Berghammer                                                        const char *reg_name,
131068f8a7eSTamas Berghammer                                                        uint32_t size,
132b9c1b51eSKate Stone                                                        RegisterValue &value) {
133*4fa1ad05SPavel Labath   Log *log = GetLog(POSIXLog::Registers);
134c7512fdcSPavel Labath 
1354a9babb2SPavel Labath   long data;
13697206d57SZachary Turner   Status error = NativeProcessLinux::PtraceWrapper(
137b9c1b51eSKate Stone       PTRACE_PEEKUSER, m_thread.GetID(), reinterpret_cast<void *>(offset),
138b9c1b51eSKate Stone       nullptr, 0, &data);
139c7512fdcSPavel Labath 
140c7512fdcSPavel Labath   if (error.Success())
1411bd3c9abSChaoren Lin     // First cast to an unsigned of the same size to avoid sign extension.
142a160ae8aSNitesh Jain     value.SetUInt(static_cast<unsigned long>(data), size);
143c7512fdcSPavel Labath 
144ea1b6b17SPavel Labath   LLDB_LOG(log, "{0}: {1:x}", reg_name, data);
145c7512fdcSPavel Labath   return error;
146068f8a7eSTamas Berghammer }
147068f8a7eSTamas Berghammer 
DoWriteRegisterValue(uint32_t offset,const char * reg_name,const RegisterValue & value)14897206d57SZachary Turner Status NativeRegisterContextLinux::DoWriteRegisterValue(
149b9c1b51eSKate Stone     uint32_t offset, const char *reg_name, const RegisterValue &value) {
150*4fa1ad05SPavel Labath   Log *log = GetLog(POSIXLog::Registers);
151c7512fdcSPavel Labath 
152c7512fdcSPavel Labath   void *buf = reinterpret_cast<void *>(value.GetAsUInt64());
153ea1b6b17SPavel Labath   LLDB_LOG(log, "{0}: {1}", reg_name, buf);
154c7512fdcSPavel Labath 
1554a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(
1564a9babb2SPavel Labath       PTRACE_POKEUSER, m_thread.GetID(), reinterpret_cast<void *>(offset), buf);
157068f8a7eSTamas Berghammer }
158