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 {
29b9c1b51eSKate Stone   // Get the target process whose privileged thread was used for the register
30b9c1b51eSKate Stone   // read.
31068f8a7eSTamas Berghammer   lldb::ByteOrder byte_order = lldb::eByteOrderInvalid;
32068f8a7eSTamas Berghammer 
33068f8a7eSTamas Berghammer   NativeProcessProtocolSP process_sp(m_thread.GetProcess());
34068f8a7eSTamas Berghammer   if (!process_sp)
35068f8a7eSTamas Berghammer     return byte_order;
36068f8a7eSTamas Berghammer 
37b9c1b51eSKate Stone   if (!process_sp->GetByteOrder(byte_order)) {
38068f8a7eSTamas Berghammer     // FIXME log here
39068f8a7eSTamas Berghammer   }
40068f8a7eSTamas Berghammer 
41068f8a7eSTamas Berghammer   return byte_order;
42068f8a7eSTamas Berghammer }
43068f8a7eSTamas Berghammer 
44*97206d57SZachary Turner Status NativeRegisterContextLinux::ReadRegisterRaw(uint32_t reg_index,
45b9c1b51eSKate Stone                                                    RegisterValue &reg_value) {
46068f8a7eSTamas Berghammer   const RegisterInfo *const reg_info = GetRegisterInfoAtIndex(reg_index);
47068f8a7eSTamas Berghammer   if (!reg_info)
48*97206d57SZachary Turner     return Status("register %" PRIu32 " not found", reg_index);
49068f8a7eSTamas Berghammer 
50b9c1b51eSKate Stone   return DoReadRegisterValue(reg_info->byte_offset, reg_info->name,
51b9c1b51eSKate Stone                              reg_info->byte_size, reg_value);
52068f8a7eSTamas Berghammer }
53068f8a7eSTamas Berghammer 
54*97206d57SZachary Turner Status
55*97206d57SZachary Turner NativeRegisterContextLinux::WriteRegisterRaw(uint32_t reg_index,
56*97206d57SZachary Turner                                              const RegisterValue &reg_value) {
57068f8a7eSTamas Berghammer   uint32_t reg_to_write = reg_index;
58068f8a7eSTamas Berghammer   RegisterValue value_to_write = reg_value;
59068f8a7eSTamas Berghammer 
60068f8a7eSTamas Berghammer   // Check if this is a subregister of a full register.
61068f8a7eSTamas Berghammer   const RegisterInfo *reg_info = GetRegisterInfoAtIndex(reg_index);
62b9c1b51eSKate Stone   if (reg_info->invalidate_regs &&
63b9c1b51eSKate Stone       (reg_info->invalidate_regs[0] != LLDB_INVALID_REGNUM)) {
64*97206d57SZachary Turner     Status error;
65068f8a7eSTamas Berghammer 
66068f8a7eSTamas Berghammer     RegisterValue full_value;
67068f8a7eSTamas Berghammer     uint32_t full_reg = reg_info->invalidate_regs[0];
68068f8a7eSTamas Berghammer     const RegisterInfo *full_reg_info = GetRegisterInfoAtIndex(full_reg);
69068f8a7eSTamas Berghammer 
70068f8a7eSTamas Berghammer     // Read the full register.
71068f8a7eSTamas Berghammer     error = ReadRegister(full_reg_info, full_value);
72068f8a7eSTamas Berghammer     if (error.Fail())
73068f8a7eSTamas Berghammer       return error;
74068f8a7eSTamas Berghammer 
75068f8a7eSTamas Berghammer     lldb::ByteOrder byte_order = GetByteOrder();
76068f8a7eSTamas Berghammer     uint8_t dst[RegisterValue::kMaxRegisterByteSize];
77068f8a7eSTamas Berghammer 
78068f8a7eSTamas Berghammer     // Get the bytes for the full register.
79b9c1b51eSKate Stone     const uint32_t dest_size = full_value.GetAsMemoryData(
80b9c1b51eSKate Stone         full_reg_info, dst, sizeof(dst), byte_order, error);
81b9c1b51eSKate Stone     if (error.Success() && dest_size) {
82068f8a7eSTamas Berghammer       uint8_t src[RegisterValue::kMaxRegisterByteSize];
83068f8a7eSTamas Berghammer 
84068f8a7eSTamas Berghammer       // Get the bytes for the source data.
85b9c1b51eSKate Stone       const uint32_t src_size = reg_value.GetAsMemoryData(
86b9c1b51eSKate Stone           reg_info, src, sizeof(src), byte_order, error);
87b9c1b51eSKate Stone       if (error.Success() && src_size && (src_size < dest_size)) {
88068f8a7eSTamas Berghammer         // Copy the src bytes to the destination.
89068f8a7eSTamas Berghammer         memcpy(dst + (reg_info->byte_offset & 0x1), src, src_size);
90068f8a7eSTamas Berghammer         // Set this full register as the value to write.
91068f8a7eSTamas Berghammer         value_to_write.SetBytes(dst, full_value.GetByteSize(), byte_order);
92068f8a7eSTamas Berghammer         value_to_write.SetType(full_reg_info);
93068f8a7eSTamas Berghammer         reg_to_write = full_reg;
94068f8a7eSTamas Berghammer       }
95068f8a7eSTamas Berghammer     }
96068f8a7eSTamas Berghammer   }
97068f8a7eSTamas Berghammer 
98b9c1b51eSKate Stone   const RegisterInfo *const register_to_write_info_p =
99b9c1b51eSKate Stone       GetRegisterInfoAtIndex(reg_to_write);
100b9c1b51eSKate Stone   assert(register_to_write_info_p &&
101b9c1b51eSKate Stone          "register to write does not have valid RegisterInfo");
102068f8a7eSTamas Berghammer   if (!register_to_write_info_p)
103*97206d57SZachary Turner     return Status("NativeRegisterContextLinux::%s failed to get RegisterInfo "
104b9c1b51eSKate Stone                   "for write register index %" PRIu32,
105b9c1b51eSKate Stone                   __FUNCTION__, reg_to_write);
106068f8a7eSTamas Berghammer 
107c7512fdcSPavel Labath   return DoWriteRegisterValue(reg_info->byte_offset, reg_info->name, reg_value);
108068f8a7eSTamas Berghammer }
109068f8a7eSTamas Berghammer 
110*97206d57SZachary Turner Status NativeRegisterContextLinux::ReadGPR() {
111068f8a7eSTamas Berghammer   void *buf = GetGPRBuffer();
112068f8a7eSTamas Berghammer   if (!buf)
113*97206d57SZachary Turner     return Status("GPR buffer is NULL");
114068f8a7eSTamas Berghammer   size_t buf_size = GetGPRSize();
115068f8a7eSTamas Berghammer 
11619cbe96aSPavel Labath   return DoReadGPR(buf, buf_size);
117068f8a7eSTamas Berghammer }
118068f8a7eSTamas Berghammer 
119*97206d57SZachary Turner Status NativeRegisterContextLinux::WriteGPR() {
120068f8a7eSTamas Berghammer   void *buf = GetGPRBuffer();
121068f8a7eSTamas Berghammer   if (!buf)
122*97206d57SZachary Turner     return Status("GPR buffer is NULL");
123068f8a7eSTamas Berghammer   size_t buf_size = GetGPRSize();
124068f8a7eSTamas Berghammer 
12519cbe96aSPavel Labath   return DoWriteGPR(buf, buf_size);
126068f8a7eSTamas Berghammer }
127068f8a7eSTamas Berghammer 
128*97206d57SZachary Turner Status NativeRegisterContextLinux::ReadFPR() {
129068f8a7eSTamas Berghammer   void *buf = GetFPRBuffer();
130068f8a7eSTamas Berghammer   if (!buf)
131*97206d57SZachary Turner     return Status("FPR buffer is NULL");
132068f8a7eSTamas Berghammer   size_t buf_size = GetFPRSize();
133068f8a7eSTamas Berghammer 
13419cbe96aSPavel Labath   return DoReadFPR(buf, buf_size);
135068f8a7eSTamas Berghammer }
136068f8a7eSTamas Berghammer 
137*97206d57SZachary Turner Status NativeRegisterContextLinux::WriteFPR() {
138068f8a7eSTamas Berghammer   void *buf = GetFPRBuffer();
139068f8a7eSTamas Berghammer   if (!buf)
140*97206d57SZachary Turner     return Status("FPR buffer is NULL");
141068f8a7eSTamas Berghammer   size_t buf_size = GetFPRSize();
142068f8a7eSTamas Berghammer 
14319cbe96aSPavel Labath   return DoWriteFPR(buf, buf_size);
144068f8a7eSTamas Berghammer }
145068f8a7eSTamas Berghammer 
146*97206d57SZachary Turner Status NativeRegisterContextLinux::ReadRegisterSet(void *buf, size_t buf_size,
147b9c1b51eSKate Stone                                                    unsigned int regset) {
1484a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(PTRACE_GETREGSET, m_thread.GetID(),
149b9c1b51eSKate Stone                                            static_cast<void *>(&regset), buf,
150b9c1b51eSKate Stone                                            buf_size);
151068f8a7eSTamas Berghammer }
152068f8a7eSTamas Berghammer 
153*97206d57SZachary Turner Status NativeRegisterContextLinux::WriteRegisterSet(void *buf, size_t buf_size,
154b9c1b51eSKate Stone                                                     unsigned int regset) {
1554a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(PTRACE_SETREGSET, m_thread.GetID(),
156b9c1b51eSKate Stone                                            static_cast<void *>(&regset), buf,
157b9c1b51eSKate Stone                                            buf_size);
158068f8a7eSTamas Berghammer }
159068f8a7eSTamas Berghammer 
160*97206d57SZachary Turner Status NativeRegisterContextLinux::DoReadRegisterValue(uint32_t offset,
161068f8a7eSTamas Berghammer                                                        const char *reg_name,
162068f8a7eSTamas Berghammer                                                        uint32_t size,
163b9c1b51eSKate Stone                                                        RegisterValue &value) {
164c7512fdcSPavel Labath   Log *log(ProcessPOSIXLog::GetLogIfAllCategoriesSet(POSIX_LOG_REGISTERS));
165c7512fdcSPavel Labath 
1664a9babb2SPavel Labath   long data;
167*97206d57SZachary Turner   Status error = NativeProcessLinux::PtraceWrapper(
168b9c1b51eSKate Stone       PTRACE_PEEKUSER, m_thread.GetID(), reinterpret_cast<void *>(offset),
169b9c1b51eSKate Stone       nullptr, 0, &data);
170c7512fdcSPavel Labath 
171c7512fdcSPavel Labath   if (error.Success())
1721bd3c9abSChaoren Lin     // First cast to an unsigned of the same size to avoid sign extension.
173a160ae8aSNitesh Jain     value.SetUInt(static_cast<unsigned long>(data), size);
174c7512fdcSPavel Labath 
175ea1b6b17SPavel Labath   LLDB_LOG(log, "{0}: {1:x}", reg_name, data);
176c7512fdcSPavel Labath   return error;
177068f8a7eSTamas Berghammer }
178068f8a7eSTamas Berghammer 
179*97206d57SZachary Turner Status NativeRegisterContextLinux::DoWriteRegisterValue(
180b9c1b51eSKate Stone     uint32_t offset, const char *reg_name, const RegisterValue &value) {
181c7512fdcSPavel Labath   Log *log(ProcessPOSIXLog::GetLogIfAllCategoriesSet(POSIX_LOG_REGISTERS));
182c7512fdcSPavel Labath 
183c7512fdcSPavel Labath   void *buf = reinterpret_cast<void *>(value.GetAsUInt64());
184ea1b6b17SPavel Labath   LLDB_LOG(log, "{0}: {1}", reg_name, buf);
185c7512fdcSPavel Labath 
1864a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(
1874a9babb2SPavel Labath       PTRACE_POKEUSER, m_thread.GetID(), reinterpret_cast<void *>(offset), buf);
188068f8a7eSTamas Berghammer }
189068f8a7eSTamas Berghammer 
190*97206d57SZachary Turner Status NativeRegisterContextLinux::DoReadGPR(void *buf, size_t buf_size) {
191b9c1b51eSKate Stone   return NativeProcessLinux::PtraceWrapper(PTRACE_GETREGS, m_thread.GetID(),
192b9c1b51eSKate Stone                                            nullptr, buf, buf_size);
193068f8a7eSTamas Berghammer }
194068f8a7eSTamas Berghammer 
195*97206d57SZachary Turner Status NativeRegisterContextLinux::DoWriteGPR(void *buf, size_t buf_size) {
196b9c1b51eSKate Stone   return NativeProcessLinux::PtraceWrapper(PTRACE_SETREGS, m_thread.GetID(),
197b9c1b51eSKate Stone                                            nullptr, buf, buf_size);
198068f8a7eSTamas Berghammer }
199068f8a7eSTamas Berghammer 
200*97206d57SZachary Turner Status NativeRegisterContextLinux::DoReadFPR(void *buf, size_t buf_size) {
201b9c1b51eSKate Stone   return NativeProcessLinux::PtraceWrapper(PTRACE_GETFPREGS, m_thread.GetID(),
202b9c1b51eSKate Stone                                            nullptr, buf, buf_size);
203068f8a7eSTamas Berghammer }
204068f8a7eSTamas Berghammer 
205*97206d57SZachary Turner Status NativeRegisterContextLinux::DoWriteFPR(void *buf, size_t buf_size) {
206b9c1b51eSKate Stone   return NativeProcessLinux::PtraceWrapper(PTRACE_SETFPREGS, m_thread.GetID(),
207b9c1b51eSKate Stone                                            nullptr, buf, buf_size);
208068f8a7eSTamas Berghammer }
209