1068f8a7eSTamas Berghammer //===-- NativeRegisterContextLinux.cpp --------------------------*- C++ -*-===//
2068f8a7eSTamas Berghammer //
3068f8a7eSTamas Berghammer //                     The LLVM Compiler Infrastructure
4068f8a7eSTamas Berghammer //
5068f8a7eSTamas Berghammer // This file is distributed under the University of Illinois Open Source
6068f8a7eSTamas Berghammer // License. See LICENSE.TXT for details.
7068f8a7eSTamas Berghammer //
8068f8a7eSTamas Berghammer //===----------------------------------------------------------------------===//
9068f8a7eSTamas Berghammer 
10068f8a7eSTamas Berghammer #include "NativeRegisterContextLinux.h"
11068f8a7eSTamas Berghammer 
12068f8a7eSTamas Berghammer #include "lldb/Core/RegisterValue.h"
13068f8a7eSTamas Berghammer #include "lldb/Host/common/NativeProcessProtocol.h"
14068f8a7eSTamas Berghammer #include "lldb/Host/common/NativeThreadProtocol.h"
15068f8a7eSTamas Berghammer #include "lldb/Host/linux/Ptrace.h"
16068f8a7eSTamas Berghammer 
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 
22b9c1b51eSKate Stone NativeRegisterContextLinux::NativeRegisterContextLinux(
23b9c1b51eSKate Stone     NativeThreadProtocol &native_thread, uint32_t concrete_frame_idx,
24b9c1b51eSKate Stone     RegisterInfoInterface *reg_info_interface_p)
25b9c1b51eSKate Stone     : NativeRegisterContextRegisterInfo(native_thread, concrete_frame_idx,
26b9c1b51eSKate Stone                                         reg_info_interface_p) {}
27068f8a7eSTamas Berghammer 
28b9c1b51eSKate Stone lldb::ByteOrder NativeRegisterContextLinux::GetByteOrder() const {
29*578a4258SPavel Labath   return m_thread.GetProcess().GetByteOrder();
30068f8a7eSTamas Berghammer }
31068f8a7eSTamas Berghammer 
3297206d57SZachary Turner Status NativeRegisterContextLinux::ReadRegisterRaw(uint32_t reg_index,
33b9c1b51eSKate Stone                                                    RegisterValue &reg_value) {
34068f8a7eSTamas Berghammer   const RegisterInfo *const reg_info = GetRegisterInfoAtIndex(reg_index);
35068f8a7eSTamas Berghammer   if (!reg_info)
3697206d57SZachary Turner     return Status("register %" PRIu32 " not found", reg_index);
37068f8a7eSTamas Berghammer 
38b9c1b51eSKate Stone   return DoReadRegisterValue(reg_info->byte_offset, reg_info->name,
39b9c1b51eSKate Stone                              reg_info->byte_size, reg_value);
40068f8a7eSTamas Berghammer }
41068f8a7eSTamas Berghammer 
4297206d57SZachary Turner Status
4397206d57SZachary Turner NativeRegisterContextLinux::WriteRegisterRaw(uint32_t reg_index,
4497206d57SZachary Turner                                              const RegisterValue &reg_value) {
45068f8a7eSTamas Berghammer   uint32_t reg_to_write = reg_index;
46068f8a7eSTamas Berghammer   RegisterValue value_to_write = reg_value;
47068f8a7eSTamas Berghammer 
48068f8a7eSTamas Berghammer   // Check if this is a subregister of a full register.
49068f8a7eSTamas Berghammer   const RegisterInfo *reg_info = GetRegisterInfoAtIndex(reg_index);
50b9c1b51eSKate Stone   if (reg_info->invalidate_regs &&
51b9c1b51eSKate Stone       (reg_info->invalidate_regs[0] != LLDB_INVALID_REGNUM)) {
5297206d57SZachary Turner     Status error;
53068f8a7eSTamas Berghammer 
54068f8a7eSTamas Berghammer     RegisterValue full_value;
55068f8a7eSTamas Berghammer     uint32_t full_reg = reg_info->invalidate_regs[0];
56068f8a7eSTamas Berghammer     const RegisterInfo *full_reg_info = GetRegisterInfoAtIndex(full_reg);
57068f8a7eSTamas Berghammer 
58068f8a7eSTamas Berghammer     // Read the full register.
59068f8a7eSTamas Berghammer     error = ReadRegister(full_reg_info, full_value);
60068f8a7eSTamas Berghammer     if (error.Fail())
61068f8a7eSTamas Berghammer       return error;
62068f8a7eSTamas Berghammer 
63068f8a7eSTamas Berghammer     lldb::ByteOrder byte_order = GetByteOrder();
64068f8a7eSTamas Berghammer     uint8_t dst[RegisterValue::kMaxRegisterByteSize];
65068f8a7eSTamas Berghammer 
66068f8a7eSTamas Berghammer     // Get the bytes for the full register.
67b9c1b51eSKate Stone     const uint32_t dest_size = full_value.GetAsMemoryData(
68b9c1b51eSKate Stone         full_reg_info, dst, sizeof(dst), byte_order, error);
69b9c1b51eSKate Stone     if (error.Success() && dest_size) {
70068f8a7eSTamas Berghammer       uint8_t src[RegisterValue::kMaxRegisterByteSize];
71068f8a7eSTamas Berghammer 
72068f8a7eSTamas Berghammer       // Get the bytes for the source data.
73b9c1b51eSKate Stone       const uint32_t src_size = reg_value.GetAsMemoryData(
74b9c1b51eSKate Stone           reg_info, src, sizeof(src), byte_order, error);
75b9c1b51eSKate Stone       if (error.Success() && src_size && (src_size < dest_size)) {
76068f8a7eSTamas Berghammer         // Copy the src bytes to the destination.
77068f8a7eSTamas Berghammer         memcpy(dst + (reg_info->byte_offset & 0x1), src, src_size);
78068f8a7eSTamas Berghammer         // Set this full register as the value to write.
79068f8a7eSTamas Berghammer         value_to_write.SetBytes(dst, full_value.GetByteSize(), byte_order);
80068f8a7eSTamas Berghammer         value_to_write.SetType(full_reg_info);
81068f8a7eSTamas Berghammer         reg_to_write = full_reg;
82068f8a7eSTamas Berghammer       }
83068f8a7eSTamas Berghammer     }
84068f8a7eSTamas Berghammer   }
85068f8a7eSTamas Berghammer 
86b9c1b51eSKate Stone   const RegisterInfo *const register_to_write_info_p =
87b9c1b51eSKate Stone       GetRegisterInfoAtIndex(reg_to_write);
88b9c1b51eSKate Stone   assert(register_to_write_info_p &&
89b9c1b51eSKate Stone          "register to write does not have valid RegisterInfo");
90068f8a7eSTamas Berghammer   if (!register_to_write_info_p)
9197206d57SZachary Turner     return Status("NativeRegisterContextLinux::%s failed to get RegisterInfo "
92b9c1b51eSKate Stone                   "for write register index %" PRIu32,
93b9c1b51eSKate Stone                   __FUNCTION__, reg_to_write);
94068f8a7eSTamas Berghammer 
95c7512fdcSPavel Labath   return DoWriteRegisterValue(reg_info->byte_offset, reg_info->name, reg_value);
96068f8a7eSTamas Berghammer }
97068f8a7eSTamas Berghammer 
9897206d57SZachary Turner Status NativeRegisterContextLinux::ReadGPR() {
99068f8a7eSTamas Berghammer   void *buf = GetGPRBuffer();
100068f8a7eSTamas Berghammer   if (!buf)
10197206d57SZachary Turner     return Status("GPR buffer is NULL");
102068f8a7eSTamas Berghammer   size_t buf_size = GetGPRSize();
103068f8a7eSTamas Berghammer 
10419cbe96aSPavel Labath   return DoReadGPR(buf, buf_size);
105068f8a7eSTamas Berghammer }
106068f8a7eSTamas Berghammer 
10797206d57SZachary Turner Status NativeRegisterContextLinux::WriteGPR() {
108068f8a7eSTamas Berghammer   void *buf = GetGPRBuffer();
109068f8a7eSTamas Berghammer   if (!buf)
11097206d57SZachary Turner     return Status("GPR buffer is NULL");
111068f8a7eSTamas Berghammer   size_t buf_size = GetGPRSize();
112068f8a7eSTamas Berghammer 
11319cbe96aSPavel Labath   return DoWriteGPR(buf, buf_size);
114068f8a7eSTamas Berghammer }
115068f8a7eSTamas Berghammer 
11697206d57SZachary Turner Status NativeRegisterContextLinux::ReadFPR() {
117068f8a7eSTamas Berghammer   void *buf = GetFPRBuffer();
118068f8a7eSTamas Berghammer   if (!buf)
11997206d57SZachary Turner     return Status("FPR buffer is NULL");
120068f8a7eSTamas Berghammer   size_t buf_size = GetFPRSize();
121068f8a7eSTamas Berghammer 
12219cbe96aSPavel Labath   return DoReadFPR(buf, buf_size);
123068f8a7eSTamas Berghammer }
124068f8a7eSTamas Berghammer 
12597206d57SZachary Turner Status NativeRegisterContextLinux::WriteFPR() {
126068f8a7eSTamas Berghammer   void *buf = GetFPRBuffer();
127068f8a7eSTamas Berghammer   if (!buf)
12897206d57SZachary Turner     return Status("FPR buffer is NULL");
129068f8a7eSTamas Berghammer   size_t buf_size = GetFPRSize();
130068f8a7eSTamas Berghammer 
13119cbe96aSPavel Labath   return DoWriteFPR(buf, buf_size);
132068f8a7eSTamas Berghammer }
133068f8a7eSTamas Berghammer 
13497206d57SZachary Turner Status NativeRegisterContextLinux::ReadRegisterSet(void *buf, size_t buf_size,
135b9c1b51eSKate Stone                                                    unsigned int regset) {
1364a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(PTRACE_GETREGSET, m_thread.GetID(),
137b9c1b51eSKate Stone                                            static_cast<void *>(&regset), buf,
138b9c1b51eSKate Stone                                            buf_size);
139068f8a7eSTamas Berghammer }
140068f8a7eSTamas Berghammer 
14197206d57SZachary Turner Status NativeRegisterContextLinux::WriteRegisterSet(void *buf, size_t buf_size,
142b9c1b51eSKate Stone                                                     unsigned int regset) {
1434a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(PTRACE_SETREGSET, m_thread.GetID(),
144b9c1b51eSKate Stone                                            static_cast<void *>(&regset), buf,
145b9c1b51eSKate Stone                                            buf_size);
146068f8a7eSTamas Berghammer }
147068f8a7eSTamas Berghammer 
14897206d57SZachary Turner Status NativeRegisterContextLinux::DoReadRegisterValue(uint32_t offset,
149068f8a7eSTamas Berghammer                                                        const char *reg_name,
150068f8a7eSTamas Berghammer                                                        uint32_t size,
151b9c1b51eSKate Stone                                                        RegisterValue &value) {
152c7512fdcSPavel Labath   Log *log(ProcessPOSIXLog::GetLogIfAllCategoriesSet(POSIX_LOG_REGISTERS));
153c7512fdcSPavel Labath 
1544a9babb2SPavel Labath   long data;
15597206d57SZachary Turner   Status error = NativeProcessLinux::PtraceWrapper(
156b9c1b51eSKate Stone       PTRACE_PEEKUSER, m_thread.GetID(), reinterpret_cast<void *>(offset),
157b9c1b51eSKate Stone       nullptr, 0, &data);
158c7512fdcSPavel Labath 
159c7512fdcSPavel Labath   if (error.Success())
1601bd3c9abSChaoren Lin     // First cast to an unsigned of the same size to avoid sign extension.
161a160ae8aSNitesh Jain     value.SetUInt(static_cast<unsigned long>(data), size);
162c7512fdcSPavel Labath 
163ea1b6b17SPavel Labath   LLDB_LOG(log, "{0}: {1:x}", reg_name, data);
164c7512fdcSPavel Labath   return error;
165068f8a7eSTamas Berghammer }
166068f8a7eSTamas Berghammer 
16797206d57SZachary Turner Status NativeRegisterContextLinux::DoWriteRegisterValue(
168b9c1b51eSKate Stone     uint32_t offset, const char *reg_name, const RegisterValue &value) {
169c7512fdcSPavel Labath   Log *log(ProcessPOSIXLog::GetLogIfAllCategoriesSet(POSIX_LOG_REGISTERS));
170c7512fdcSPavel Labath 
171c7512fdcSPavel Labath   void *buf = reinterpret_cast<void *>(value.GetAsUInt64());
172ea1b6b17SPavel Labath   LLDB_LOG(log, "{0}: {1}", reg_name, buf);
173c7512fdcSPavel Labath 
1744a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(
1754a9babb2SPavel Labath       PTRACE_POKEUSER, m_thread.GetID(), reinterpret_cast<void *>(offset), buf);
176068f8a7eSTamas Berghammer }
177068f8a7eSTamas Berghammer 
17897206d57SZachary Turner Status NativeRegisterContextLinux::DoReadGPR(void *buf, size_t buf_size) {
179b9c1b51eSKate Stone   return NativeProcessLinux::PtraceWrapper(PTRACE_GETREGS, m_thread.GetID(),
180b9c1b51eSKate Stone                                            nullptr, buf, buf_size);
181068f8a7eSTamas Berghammer }
182068f8a7eSTamas Berghammer 
18397206d57SZachary Turner Status NativeRegisterContextLinux::DoWriteGPR(void *buf, size_t buf_size) {
184b9c1b51eSKate Stone   return NativeProcessLinux::PtraceWrapper(PTRACE_SETREGS, m_thread.GetID(),
185b9c1b51eSKate Stone                                            nullptr, buf, buf_size);
186068f8a7eSTamas Berghammer }
187068f8a7eSTamas Berghammer 
18897206d57SZachary Turner Status NativeRegisterContextLinux::DoReadFPR(void *buf, size_t buf_size) {
189b9c1b51eSKate Stone   return NativeProcessLinux::PtraceWrapper(PTRACE_GETFPREGS, m_thread.GetID(),
190b9c1b51eSKate Stone                                            nullptr, buf, buf_size);
191068f8a7eSTamas Berghammer }
192068f8a7eSTamas Berghammer 
19397206d57SZachary Turner Status NativeRegisterContextLinux::DoWriteFPR(void *buf, size_t buf_size) {
194b9c1b51eSKate Stone   return NativeProcessLinux::PtraceWrapper(PTRACE_SETFPREGS, m_thread.GetID(),
195b9c1b51eSKate Stone                                            nullptr, buf, buf_size);
196068f8a7eSTamas Berghammer }
197