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 
22068f8a7eSTamas Berghammer NativeRegisterContextLinux::NativeRegisterContextLinux(NativeThreadProtocol &native_thread,
23068f8a7eSTamas Berghammer                                                        uint32_t concrete_frame_idx,
24068f8a7eSTamas Berghammer                                                        RegisterInfoInterface *reg_info_interface_p) :
25068f8a7eSTamas Berghammer 	NativeRegisterContextRegisterInfo(native_thread, concrete_frame_idx, reg_info_interface_p)
26068f8a7eSTamas Berghammer {}
27068f8a7eSTamas Berghammer 
28068f8a7eSTamas Berghammer lldb::ByteOrder
29068f8a7eSTamas Berghammer NativeRegisterContextLinux::GetByteOrder() const
30068f8a7eSTamas Berghammer {
31068f8a7eSTamas Berghammer     // Get the target process whose privileged thread was used for the register read.
32068f8a7eSTamas Berghammer     lldb::ByteOrder byte_order = lldb::eByteOrderInvalid;
33068f8a7eSTamas Berghammer 
34068f8a7eSTamas Berghammer     NativeProcessProtocolSP process_sp (m_thread.GetProcess ());
35068f8a7eSTamas Berghammer     if (!process_sp)
36068f8a7eSTamas Berghammer         return byte_order;
37068f8a7eSTamas Berghammer 
38068f8a7eSTamas Berghammer     if (!process_sp->GetByteOrder (byte_order))
39068f8a7eSTamas Berghammer     {
40068f8a7eSTamas Berghammer         // FIXME log here
41068f8a7eSTamas Berghammer     }
42068f8a7eSTamas Berghammer 
43068f8a7eSTamas Berghammer     return byte_order;
44068f8a7eSTamas Berghammer }
45068f8a7eSTamas Berghammer 
46068f8a7eSTamas Berghammer Error
47068f8a7eSTamas Berghammer NativeRegisterContextLinux::ReadRegisterRaw(uint32_t reg_index, RegisterValue &reg_value)
48068f8a7eSTamas Berghammer {
49068f8a7eSTamas Berghammer     const RegisterInfo *const reg_info = GetRegisterInfoAtIndex(reg_index);
50068f8a7eSTamas Berghammer     if (!reg_info)
51068f8a7eSTamas Berghammer     	return Error("register %" PRIu32 " not found", reg_index);
52068f8a7eSTamas Berghammer 
53068f8a7eSTamas Berghammer     NativeProcessProtocolSP process_sp(m_thread.GetProcess());
54068f8a7eSTamas Berghammer     if (!process_sp)
55068f8a7eSTamas Berghammer         return Error("NativeProcessProtocol is NULL");
56068f8a7eSTamas Berghammer 
57068f8a7eSTamas Berghammer     NativeProcessLinux* process_p = static_cast<NativeProcessLinux*>(process_sp.get());
58*c7512fdcSPavel Labath     return process_p->DoOperation([&] {
59*c7512fdcSPavel Labath         return DoReadRegisterValue(reg_info->byte_offset, reg_info->name, reg_info->byte_size, reg_value);
60*c7512fdcSPavel Labath     });
61068f8a7eSTamas Berghammer }
62068f8a7eSTamas Berghammer 
63068f8a7eSTamas Berghammer Error
64068f8a7eSTamas Berghammer NativeRegisterContextLinux::WriteRegisterRaw(uint32_t reg_index, const RegisterValue &reg_value)
65068f8a7eSTamas Berghammer {
66068f8a7eSTamas Berghammer     uint32_t reg_to_write = reg_index;
67068f8a7eSTamas Berghammer     RegisterValue value_to_write = reg_value;
68068f8a7eSTamas Berghammer 
69068f8a7eSTamas Berghammer     // Check if this is a subregister of a full register.
70068f8a7eSTamas Berghammer     const RegisterInfo *reg_info = GetRegisterInfoAtIndex(reg_index);
71068f8a7eSTamas Berghammer     if (reg_info->invalidate_regs && (reg_info->invalidate_regs[0] != LLDB_INVALID_REGNUM))
72068f8a7eSTamas Berghammer     {
73068f8a7eSTamas Berghammer 		Error error;
74068f8a7eSTamas Berghammer 
75068f8a7eSTamas Berghammer         RegisterValue full_value;
76068f8a7eSTamas Berghammer         uint32_t full_reg = reg_info->invalidate_regs[0];
77068f8a7eSTamas Berghammer         const RegisterInfo *full_reg_info = GetRegisterInfoAtIndex(full_reg);
78068f8a7eSTamas Berghammer 
79068f8a7eSTamas Berghammer         // Read the full register.
80068f8a7eSTamas Berghammer         error = ReadRegister(full_reg_info, full_value);
81068f8a7eSTamas Berghammer         if (error.Fail ())
82068f8a7eSTamas Berghammer             return error;
83068f8a7eSTamas Berghammer 
84068f8a7eSTamas Berghammer         lldb::ByteOrder byte_order = GetByteOrder();
85068f8a7eSTamas Berghammer         uint8_t dst[RegisterValue::kMaxRegisterByteSize];
86068f8a7eSTamas Berghammer 
87068f8a7eSTamas Berghammer         // Get the bytes for the full register.
88068f8a7eSTamas Berghammer         const uint32_t dest_size = full_value.GetAsMemoryData (full_reg_info,
89068f8a7eSTamas Berghammer                                                                dst,
90068f8a7eSTamas Berghammer                                                                sizeof(dst),
91068f8a7eSTamas Berghammer                                                                byte_order,
92068f8a7eSTamas Berghammer                                                                error);
93068f8a7eSTamas Berghammer         if (error.Success() && dest_size)
94068f8a7eSTamas Berghammer         {
95068f8a7eSTamas Berghammer             uint8_t src[RegisterValue::kMaxRegisterByteSize];
96068f8a7eSTamas Berghammer 
97068f8a7eSTamas Berghammer             // Get the bytes for the source data.
98068f8a7eSTamas Berghammer             const uint32_t src_size = reg_value.GetAsMemoryData (reg_info, src, sizeof(src), byte_order, error);
99068f8a7eSTamas Berghammer             if (error.Success() && src_size && (src_size < dest_size))
100068f8a7eSTamas Berghammer             {
101068f8a7eSTamas Berghammer                 // Copy the src bytes to the destination.
102068f8a7eSTamas Berghammer                 memcpy (dst + (reg_info->byte_offset & 0x1), src, src_size);
103068f8a7eSTamas Berghammer                 // Set this full register as the value to write.
104068f8a7eSTamas Berghammer                 value_to_write.SetBytes(dst, full_value.GetByteSize(), byte_order);
105068f8a7eSTamas Berghammer                 value_to_write.SetType(full_reg_info);
106068f8a7eSTamas Berghammer                 reg_to_write = full_reg;
107068f8a7eSTamas Berghammer             }
108068f8a7eSTamas Berghammer         }
109068f8a7eSTamas Berghammer     }
110068f8a7eSTamas Berghammer 
111068f8a7eSTamas Berghammer     NativeProcessProtocolSP process_sp (m_thread.GetProcess ());
112068f8a7eSTamas Berghammer     if (!process_sp)
113068f8a7eSTamas Berghammer 	    return Error("NativeProcessProtocol is NULL");
114068f8a7eSTamas Berghammer 
115068f8a7eSTamas Berghammer     const RegisterInfo *const register_to_write_info_p = GetRegisterInfoAtIndex (reg_to_write);
116068f8a7eSTamas Berghammer     assert (register_to_write_info_p && "register to write does not have valid RegisterInfo");
117068f8a7eSTamas Berghammer     if (!register_to_write_info_p)
118068f8a7eSTamas Berghammer         return Error("NativeRegisterContextLinux::%s failed to get RegisterInfo for write register index %" PRIu32, __FUNCTION__, reg_to_write);
119068f8a7eSTamas Berghammer 
120068f8a7eSTamas Berghammer     NativeProcessLinux* process_p = static_cast<NativeProcessLinux*> (process_sp.get ());
121*c7512fdcSPavel Labath     return process_p->DoOperation([&] {
122*c7512fdcSPavel Labath         return DoWriteRegisterValue(reg_info->byte_offset, reg_info->name, reg_value);
123*c7512fdcSPavel Labath     });
124068f8a7eSTamas Berghammer }
125068f8a7eSTamas Berghammer 
126068f8a7eSTamas Berghammer Error
127068f8a7eSTamas Berghammer NativeRegisterContextLinux::ReadGPR()
128068f8a7eSTamas Berghammer {
129068f8a7eSTamas Berghammer 	NativeProcessProtocolSP process_sp (m_thread.GetProcess ());
130068f8a7eSTamas Berghammer     if (!process_sp)
131068f8a7eSTamas Berghammer         return Error("NativeProcessProtocol is NULL");
132068f8a7eSTamas Berghammer 
133068f8a7eSTamas Berghammer     void* buf = GetGPRBuffer();
134068f8a7eSTamas Berghammer     if (!buf)
135068f8a7eSTamas Berghammer     	return Error("GPR buffer is NULL");
136068f8a7eSTamas Berghammer     size_t buf_size = GetGPRSize();
137068f8a7eSTamas Berghammer 
138068f8a7eSTamas Berghammer     NativeProcessLinux* process_p = static_cast<NativeProcessLinux*>(process_sp.get());
139*c7512fdcSPavel Labath     return process_p->DoOperation([&] { return DoReadGPR(buf, buf_size); });
140068f8a7eSTamas Berghammer }
141068f8a7eSTamas Berghammer 
142068f8a7eSTamas Berghammer Error
143068f8a7eSTamas Berghammer NativeRegisterContextLinux::WriteGPR()
144068f8a7eSTamas Berghammer {
145068f8a7eSTamas Berghammer 	NativeProcessProtocolSP process_sp (m_thread.GetProcess ());
146068f8a7eSTamas Berghammer     if (!process_sp)
147068f8a7eSTamas Berghammer         return Error("NativeProcessProtocol is NULL");
148068f8a7eSTamas Berghammer 
149068f8a7eSTamas Berghammer     void* buf = GetGPRBuffer();
150068f8a7eSTamas Berghammer     if (!buf)
151068f8a7eSTamas Berghammer     	return Error("GPR buffer is NULL");
152068f8a7eSTamas Berghammer     size_t buf_size = GetGPRSize();
153068f8a7eSTamas Berghammer 
154068f8a7eSTamas Berghammer     NativeProcessLinux* process_p = static_cast<NativeProcessLinux*>(process_sp.get());
155*c7512fdcSPavel Labath     return process_p->DoOperation([&] { return DoWriteGPR(buf, buf_size); });
156068f8a7eSTamas Berghammer }
157068f8a7eSTamas Berghammer 
158068f8a7eSTamas Berghammer Error
159068f8a7eSTamas Berghammer NativeRegisterContextLinux::ReadFPR()
160068f8a7eSTamas Berghammer {
161068f8a7eSTamas Berghammer 	NativeProcessProtocolSP process_sp (m_thread.GetProcess ());
162068f8a7eSTamas Berghammer     if (!process_sp)
163068f8a7eSTamas Berghammer         return Error("NativeProcessProtocol is NULL");
164068f8a7eSTamas Berghammer 
165068f8a7eSTamas Berghammer     void* buf = GetFPRBuffer();
166068f8a7eSTamas Berghammer     if (!buf)
167068f8a7eSTamas Berghammer     	return Error("GPR buffer is NULL");
168068f8a7eSTamas Berghammer     size_t buf_size = GetFPRSize();
169068f8a7eSTamas Berghammer 
170068f8a7eSTamas Berghammer     NativeProcessLinux* process_p = static_cast<NativeProcessLinux*>(process_sp.get());
171*c7512fdcSPavel Labath     return process_p->DoOperation([&] { return DoReadFPR(buf, buf_size); });
172068f8a7eSTamas Berghammer }
173068f8a7eSTamas Berghammer 
174068f8a7eSTamas Berghammer Error
175068f8a7eSTamas Berghammer NativeRegisterContextLinux::WriteFPR()
176068f8a7eSTamas Berghammer {
177068f8a7eSTamas Berghammer 	NativeProcessProtocolSP process_sp (m_thread.GetProcess ());
178068f8a7eSTamas Berghammer     if (!process_sp)
179068f8a7eSTamas Berghammer         return Error("NativeProcessProtocol is NULL");
180068f8a7eSTamas Berghammer 
181068f8a7eSTamas Berghammer     void* buf = GetFPRBuffer();
182068f8a7eSTamas Berghammer     if (!buf)
183068f8a7eSTamas Berghammer     	return Error("GPR buffer is NULL");
184068f8a7eSTamas Berghammer     size_t buf_size = GetFPRSize();
185068f8a7eSTamas Berghammer 
186068f8a7eSTamas Berghammer     NativeProcessLinux* process_p = static_cast<NativeProcessLinux*>(process_sp.get());
187*c7512fdcSPavel Labath     return process_p->DoOperation([&] { return DoWriteFPR(buf, buf_size); });
188068f8a7eSTamas Berghammer }
189068f8a7eSTamas Berghammer 
190068f8a7eSTamas Berghammer Error
191068f8a7eSTamas Berghammer NativeRegisterContextLinux::ReadRegisterSet(void *buf, size_t buf_size, unsigned int regset)
192068f8a7eSTamas Berghammer {
193068f8a7eSTamas Berghammer     NativeProcessProtocolSP process_sp (m_thread.GetProcess());
194068f8a7eSTamas Berghammer     if (!process_sp)
195068f8a7eSTamas Berghammer         return Error("NativeProcessProtocol is NULL");
196068f8a7eSTamas Berghammer     NativeProcessLinux* process_p = static_cast<NativeProcessLinux*>(process_sp.get());
197068f8a7eSTamas Berghammer 
198*c7512fdcSPavel Labath     return process_p->DoOperation([&] {
199*c7512fdcSPavel Labath         Error error;
200*c7512fdcSPavel Labath         NativeProcessLinux::PtraceWrapper(PTRACE_GETREGSET, m_thread.GetID(),
201*c7512fdcSPavel Labath                 static_cast<void *>(&regset), buf, buf_size, error);
202*c7512fdcSPavel Labath         return error;
203*c7512fdcSPavel Labath     });
204068f8a7eSTamas Berghammer }
205068f8a7eSTamas Berghammer 
206068f8a7eSTamas Berghammer Error
207068f8a7eSTamas Berghammer NativeRegisterContextLinux::WriteRegisterSet(void *buf, size_t buf_size, unsigned int regset)
208068f8a7eSTamas Berghammer {
209068f8a7eSTamas Berghammer     NativeProcessProtocolSP process_sp (m_thread.GetProcess());
210068f8a7eSTamas Berghammer     if (!process_sp)
211068f8a7eSTamas Berghammer         return Error("NativeProcessProtocol is NULL");
212068f8a7eSTamas Berghammer     NativeProcessLinux* process_p = static_cast<NativeProcessLinux*>(process_sp.get());
213068f8a7eSTamas Berghammer 
214*c7512fdcSPavel Labath     return process_p->DoOperation([&] {
215*c7512fdcSPavel Labath         Error error;
216*c7512fdcSPavel Labath         NativeProcessLinux::PtraceWrapper(PTRACE_SETREGSET, m_thread.GetID(),
217*c7512fdcSPavel Labath                 static_cast<void *>(&regset), buf, buf_size, error);
218*c7512fdcSPavel Labath         return error;
219*c7512fdcSPavel Labath     });
220068f8a7eSTamas Berghammer }
221068f8a7eSTamas Berghammer 
222*c7512fdcSPavel Labath Error
223*c7512fdcSPavel Labath NativeRegisterContextLinux::DoReadRegisterValue(uint32_t offset,
224068f8a7eSTamas Berghammer                                                 const char* reg_name,
225068f8a7eSTamas Berghammer                                                 uint32_t size,
226068f8a7eSTamas Berghammer                                                 RegisterValue &value)
227068f8a7eSTamas Berghammer {
228*c7512fdcSPavel Labath     Log *log (ProcessPOSIXLog::GetLogIfAllCategoriesSet (POSIX_LOG_REGISTERS));
229*c7512fdcSPavel Labath     Error error;
230*c7512fdcSPavel Labath 
231*c7512fdcSPavel Labath     lldb::addr_t data = NativeProcessLinux::PtraceWrapper(
232*c7512fdcSPavel Labath             PTRACE_PEEKUSER, m_thread.GetID(), reinterpret_cast<void *>(offset), nullptr, 0, error);
233*c7512fdcSPavel Labath 
234*c7512fdcSPavel Labath     if (error.Success())
235*c7512fdcSPavel Labath         value = data;
236*c7512fdcSPavel Labath 
237*c7512fdcSPavel Labath     if (log)
238*c7512fdcSPavel Labath         log->Printf ("NativeRegisterContextLinux::%s() reg %s: 0x%" PRIx64, __FUNCTION__, reg_name, data);
239*c7512fdcSPavel Labath 
240*c7512fdcSPavel Labath     return error;
241068f8a7eSTamas Berghammer }
242068f8a7eSTamas Berghammer 
243*c7512fdcSPavel Labath Error
244*c7512fdcSPavel Labath NativeRegisterContextLinux::DoWriteRegisterValue(uint32_t offset,
245068f8a7eSTamas Berghammer                                                  const char* reg_name,
246068f8a7eSTamas Berghammer                                                  const RegisterValue &value)
247068f8a7eSTamas Berghammer {
248*c7512fdcSPavel Labath     Log *log (ProcessPOSIXLog::GetLogIfAllCategoriesSet (POSIX_LOG_REGISTERS));
249*c7512fdcSPavel Labath 
250*c7512fdcSPavel Labath     void* buf = reinterpret_cast<void *>(value.GetAsUInt64());
251*c7512fdcSPavel Labath 
252*c7512fdcSPavel Labath     if (log)
253*c7512fdcSPavel Labath         log->Printf ("NativeRegisterContextLinux::%s() reg %s: %p", __FUNCTION__, reg_name, buf);
254*c7512fdcSPavel Labath 
255*c7512fdcSPavel Labath     Error error;
256*c7512fdcSPavel Labath     NativeProcessLinux::PtraceWrapper(
257*c7512fdcSPavel Labath             PTRACE_POKEUSER, m_thread.GetID(), reinterpret_cast<void *>(offset), buf, 0, error);
258*c7512fdcSPavel Labath 
259*c7512fdcSPavel Labath     return error;
260068f8a7eSTamas Berghammer }
261068f8a7eSTamas Berghammer 
262*c7512fdcSPavel Labath Error
263*c7512fdcSPavel Labath NativeRegisterContextLinux::DoReadGPR(void *buf, size_t buf_size)
264068f8a7eSTamas Berghammer {
265*c7512fdcSPavel Labath     Error error;
266*c7512fdcSPavel Labath     NativeProcessLinux::PtraceWrapper(PTRACE_GETREGS, m_thread.GetID(), nullptr, buf, buf_size, error);
267*c7512fdcSPavel Labath     return error;
268068f8a7eSTamas Berghammer }
269068f8a7eSTamas Berghammer 
270*c7512fdcSPavel Labath Error
271*c7512fdcSPavel Labath NativeRegisterContextLinux::DoWriteGPR(void *buf, size_t buf_size)
272068f8a7eSTamas Berghammer {
273*c7512fdcSPavel Labath     Error error;
274*c7512fdcSPavel Labath     NativeProcessLinux::PtraceWrapper(PTRACE_SETREGS, m_thread.GetID(), nullptr, buf, buf_size, error);
275*c7512fdcSPavel Labath     return error;
276068f8a7eSTamas Berghammer }
277068f8a7eSTamas Berghammer 
278*c7512fdcSPavel Labath Error
279*c7512fdcSPavel Labath NativeRegisterContextLinux::DoReadFPR(void *buf, size_t buf_size)
280068f8a7eSTamas Berghammer {
281*c7512fdcSPavel Labath     Error error;
282*c7512fdcSPavel Labath     NativeProcessLinux::PtraceWrapper(PTRACE_GETFPREGS, m_thread.GetID(), nullptr, buf, buf_size, error);
283*c7512fdcSPavel Labath     return error;
284068f8a7eSTamas Berghammer }
285068f8a7eSTamas Berghammer 
286*c7512fdcSPavel Labath Error
287*c7512fdcSPavel Labath NativeRegisterContextLinux::DoWriteFPR(void *buf, size_t buf_size)
288068f8a7eSTamas Berghammer {
289*c7512fdcSPavel Labath     Error error;
290*c7512fdcSPavel Labath     NativeProcessLinux::PtraceWrapper(PTRACE_SETFPREGS, m_thread.GetID(), nullptr, buf, buf_size, error);
291*c7512fdcSPavel Labath     return error;
292068f8a7eSTamas Berghammer }
293