1068f8a7eSTamas Berghammer //===-- NativeRegisterContextLinux.cpp --------------------------*- C++ -*-===//
2068f8a7eSTamas Berghammer //
3*2946cd70SChandler Carruth // Part of the LLVM Project, under the Apache License v2.0 with LLVM Exceptions.
4*2946cd70SChandler Carruth // See https://llvm.org/LICENSE.txt for license information.
5*2946cd70SChandler 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 
22b9c1b51eSKate Stone NativeRegisterContextLinux::NativeRegisterContextLinux(
23d37349f3SPavel Labath     NativeThreadProtocol &native_thread,
24b9c1b51eSKate Stone     RegisterInfoInterface *reg_info_interface_p)
25d37349f3SPavel Labath     : NativeRegisterContextRegisterInfo(native_thread, reg_info_interface_p) {}
26068f8a7eSTamas Berghammer 
27b9c1b51eSKate Stone lldb::ByteOrder NativeRegisterContextLinux::GetByteOrder() const {
28578a4258SPavel Labath   return m_thread.GetProcess().GetByteOrder();
29068f8a7eSTamas Berghammer }
30068f8a7eSTamas Berghammer 
3197206d57SZachary Turner Status NativeRegisterContextLinux::ReadRegisterRaw(uint32_t reg_index,
32b9c1b51eSKate Stone                                                    RegisterValue &reg_value) {
33068f8a7eSTamas Berghammer   const RegisterInfo *const reg_info = GetRegisterInfoAtIndex(reg_index);
34068f8a7eSTamas Berghammer   if (!reg_info)
3597206d57SZachary Turner     return Status("register %" PRIu32 " not found", reg_index);
36068f8a7eSTamas Berghammer 
37b9c1b51eSKate Stone   return DoReadRegisterValue(reg_info->byte_offset, reg_info->name,
38b9c1b51eSKate Stone                              reg_info->byte_size, reg_value);
39068f8a7eSTamas Berghammer }
40068f8a7eSTamas Berghammer 
4197206d57SZachary Turner Status
4297206d57SZachary Turner NativeRegisterContextLinux::WriteRegisterRaw(uint32_t reg_index,
4397206d57SZachary Turner                                              const RegisterValue &reg_value) {
44068f8a7eSTamas Berghammer   uint32_t reg_to_write = reg_index;
45068f8a7eSTamas Berghammer   RegisterValue value_to_write = reg_value;
46068f8a7eSTamas Berghammer 
47068f8a7eSTamas Berghammer   // Check if this is a subregister of a full register.
48068f8a7eSTamas Berghammer   const RegisterInfo *reg_info = GetRegisterInfoAtIndex(reg_index);
49b9c1b51eSKate Stone   if (reg_info->invalidate_regs &&
50b9c1b51eSKate Stone       (reg_info->invalidate_regs[0] != LLDB_INVALID_REGNUM)) {
5197206d57SZachary Turner     Status error;
52068f8a7eSTamas Berghammer 
53068f8a7eSTamas Berghammer     RegisterValue full_value;
54068f8a7eSTamas Berghammer     uint32_t full_reg = reg_info->invalidate_regs[0];
55068f8a7eSTamas Berghammer     const RegisterInfo *full_reg_info = GetRegisterInfoAtIndex(full_reg);
56068f8a7eSTamas Berghammer 
57068f8a7eSTamas Berghammer     // Read the full register.
58068f8a7eSTamas Berghammer     error = ReadRegister(full_reg_info, full_value);
59068f8a7eSTamas Berghammer     if (error.Fail())
60068f8a7eSTamas Berghammer       return error;
61068f8a7eSTamas Berghammer 
62068f8a7eSTamas Berghammer     lldb::ByteOrder byte_order = GetByteOrder();
63068f8a7eSTamas Berghammer     uint8_t dst[RegisterValue::kMaxRegisterByteSize];
64068f8a7eSTamas Berghammer 
65068f8a7eSTamas Berghammer     // Get the bytes for the full register.
66b9c1b51eSKate Stone     const uint32_t dest_size = full_value.GetAsMemoryData(
67b9c1b51eSKate Stone         full_reg_info, dst, sizeof(dst), byte_order, error);
68b9c1b51eSKate Stone     if (error.Success() && dest_size) {
69068f8a7eSTamas Berghammer       uint8_t src[RegisterValue::kMaxRegisterByteSize];
70068f8a7eSTamas Berghammer 
71068f8a7eSTamas Berghammer       // Get the bytes for the source data.
72b9c1b51eSKate Stone       const uint32_t src_size = reg_value.GetAsMemoryData(
73b9c1b51eSKate Stone           reg_info, src, sizeof(src), byte_order, error);
74b9c1b51eSKate Stone       if (error.Success() && src_size && (src_size < dest_size)) {
75068f8a7eSTamas Berghammer         // Copy the src bytes to the destination.
76068f8a7eSTamas Berghammer         memcpy(dst + (reg_info->byte_offset & 0x1), src, src_size);
77068f8a7eSTamas Berghammer         // Set this full register as the value to write.
78068f8a7eSTamas Berghammer         value_to_write.SetBytes(dst, full_value.GetByteSize(), byte_order);
79068f8a7eSTamas Berghammer         value_to_write.SetType(full_reg_info);
80068f8a7eSTamas Berghammer         reg_to_write = full_reg;
81068f8a7eSTamas Berghammer       }
82068f8a7eSTamas Berghammer     }
83068f8a7eSTamas Berghammer   }
84068f8a7eSTamas Berghammer 
85b9c1b51eSKate Stone   const RegisterInfo *const register_to_write_info_p =
86b9c1b51eSKate Stone       GetRegisterInfoAtIndex(reg_to_write);
87b9c1b51eSKate Stone   assert(register_to_write_info_p &&
88b9c1b51eSKate Stone          "register to write does not have valid RegisterInfo");
89068f8a7eSTamas Berghammer   if (!register_to_write_info_p)
9097206d57SZachary Turner     return Status("NativeRegisterContextLinux::%s failed to get RegisterInfo "
91b9c1b51eSKate Stone                   "for write register index %" PRIu32,
92b9c1b51eSKate Stone                   __FUNCTION__, reg_to_write);
93068f8a7eSTamas Berghammer 
94c7512fdcSPavel Labath   return DoWriteRegisterValue(reg_info->byte_offset, reg_info->name, reg_value);
95068f8a7eSTamas Berghammer }
96068f8a7eSTamas Berghammer 
9797206d57SZachary Turner Status NativeRegisterContextLinux::ReadGPR() {
98068f8a7eSTamas Berghammer   void *buf = GetGPRBuffer();
99068f8a7eSTamas Berghammer   if (!buf)
10097206d57SZachary Turner     return Status("GPR buffer is NULL");
101068f8a7eSTamas Berghammer   size_t buf_size = GetGPRSize();
102068f8a7eSTamas Berghammer 
10319cbe96aSPavel Labath   return DoReadGPR(buf, buf_size);
104068f8a7eSTamas Berghammer }
105068f8a7eSTamas Berghammer 
10697206d57SZachary Turner Status NativeRegisterContextLinux::WriteGPR() {
107068f8a7eSTamas Berghammer   void *buf = GetGPRBuffer();
108068f8a7eSTamas Berghammer   if (!buf)
10997206d57SZachary Turner     return Status("GPR buffer is NULL");
110068f8a7eSTamas Berghammer   size_t buf_size = GetGPRSize();
111068f8a7eSTamas Berghammer 
11219cbe96aSPavel Labath   return DoWriteGPR(buf, buf_size);
113068f8a7eSTamas Berghammer }
114068f8a7eSTamas Berghammer 
11597206d57SZachary Turner Status NativeRegisterContextLinux::ReadFPR() {
116068f8a7eSTamas Berghammer   void *buf = GetFPRBuffer();
117068f8a7eSTamas Berghammer   if (!buf)
11897206d57SZachary Turner     return Status("FPR buffer is NULL");
119068f8a7eSTamas Berghammer   size_t buf_size = GetFPRSize();
120068f8a7eSTamas Berghammer 
12119cbe96aSPavel Labath   return DoReadFPR(buf, buf_size);
122068f8a7eSTamas Berghammer }
123068f8a7eSTamas Berghammer 
12497206d57SZachary Turner Status NativeRegisterContextLinux::WriteFPR() {
125068f8a7eSTamas Berghammer   void *buf = GetFPRBuffer();
126068f8a7eSTamas Berghammer   if (!buf)
12797206d57SZachary Turner     return Status("FPR buffer is NULL");
128068f8a7eSTamas Berghammer   size_t buf_size = GetFPRSize();
129068f8a7eSTamas Berghammer 
13019cbe96aSPavel Labath   return DoWriteFPR(buf, buf_size);
131068f8a7eSTamas Berghammer }
132068f8a7eSTamas Berghammer 
13397206d57SZachary Turner Status NativeRegisterContextLinux::ReadRegisterSet(void *buf, size_t buf_size,
134b9c1b51eSKate Stone                                                    unsigned int regset) {
1354a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(PTRACE_GETREGSET, m_thread.GetID(),
136b9c1b51eSKate Stone                                            static_cast<void *>(&regset), buf,
137b9c1b51eSKate Stone                                            buf_size);
138068f8a7eSTamas Berghammer }
139068f8a7eSTamas Berghammer 
14097206d57SZachary Turner Status NativeRegisterContextLinux::WriteRegisterSet(void *buf, size_t buf_size,
141b9c1b51eSKate Stone                                                     unsigned int regset) {
1424a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(PTRACE_SETREGSET, m_thread.GetID(),
143b9c1b51eSKate Stone                                            static_cast<void *>(&regset), buf,
144b9c1b51eSKate Stone                                            buf_size);
145068f8a7eSTamas Berghammer }
146068f8a7eSTamas Berghammer 
14797206d57SZachary Turner Status NativeRegisterContextLinux::DoReadRegisterValue(uint32_t offset,
148068f8a7eSTamas Berghammer                                                        const char *reg_name,
149068f8a7eSTamas Berghammer                                                        uint32_t size,
150b9c1b51eSKate Stone                                                        RegisterValue &value) {
151c7512fdcSPavel Labath   Log *log(ProcessPOSIXLog::GetLogIfAllCategoriesSet(POSIX_LOG_REGISTERS));
152c7512fdcSPavel Labath 
1534a9babb2SPavel Labath   long data;
15497206d57SZachary Turner   Status error = NativeProcessLinux::PtraceWrapper(
155b9c1b51eSKate Stone       PTRACE_PEEKUSER, m_thread.GetID(), reinterpret_cast<void *>(offset),
156b9c1b51eSKate Stone       nullptr, 0, &data);
157c7512fdcSPavel Labath 
158c7512fdcSPavel Labath   if (error.Success())
1591bd3c9abSChaoren Lin     // First cast to an unsigned of the same size to avoid sign extension.
160a160ae8aSNitesh Jain     value.SetUInt(static_cast<unsigned long>(data), size);
161c7512fdcSPavel Labath 
162ea1b6b17SPavel Labath   LLDB_LOG(log, "{0}: {1:x}", reg_name, data);
163c7512fdcSPavel Labath   return error;
164068f8a7eSTamas Berghammer }
165068f8a7eSTamas Berghammer 
16697206d57SZachary Turner Status NativeRegisterContextLinux::DoWriteRegisterValue(
167b9c1b51eSKate Stone     uint32_t offset, const char *reg_name, const RegisterValue &value) {
168c7512fdcSPavel Labath   Log *log(ProcessPOSIXLog::GetLogIfAllCategoriesSet(POSIX_LOG_REGISTERS));
169c7512fdcSPavel Labath 
170c7512fdcSPavel Labath   void *buf = reinterpret_cast<void *>(value.GetAsUInt64());
171ea1b6b17SPavel Labath   LLDB_LOG(log, "{0}: {1}", reg_name, buf);
172c7512fdcSPavel Labath 
1734a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(
1744a9babb2SPavel Labath       PTRACE_POKEUSER, m_thread.GetID(), reinterpret_cast<void *>(offset), buf);
175068f8a7eSTamas Berghammer }
176068f8a7eSTamas Berghammer 
17797206d57SZachary Turner Status NativeRegisterContextLinux::DoReadGPR(void *buf, size_t buf_size) {
178b9c1b51eSKate Stone   return NativeProcessLinux::PtraceWrapper(PTRACE_GETREGS, m_thread.GetID(),
179b9c1b51eSKate Stone                                            nullptr, buf, buf_size);
180068f8a7eSTamas Berghammer }
181068f8a7eSTamas Berghammer 
18297206d57SZachary Turner Status NativeRegisterContextLinux::DoWriteGPR(void *buf, size_t buf_size) {
183b9c1b51eSKate Stone   return NativeProcessLinux::PtraceWrapper(PTRACE_SETREGS, m_thread.GetID(),
184b9c1b51eSKate Stone                                            nullptr, buf, buf_size);
185068f8a7eSTamas Berghammer }
186068f8a7eSTamas Berghammer 
18797206d57SZachary Turner Status NativeRegisterContextLinux::DoReadFPR(void *buf, size_t buf_size) {
188b9c1b51eSKate Stone   return NativeProcessLinux::PtraceWrapper(PTRACE_GETFPREGS, m_thread.GetID(),
189b9c1b51eSKate Stone                                            nullptr, buf, buf_size);
190068f8a7eSTamas Berghammer }
191068f8a7eSTamas Berghammer 
19297206d57SZachary Turner Status NativeRegisterContextLinux::DoWriteFPR(void *buf, size_t buf_size) {
193b9c1b51eSKate Stone   return NativeProcessLinux::PtraceWrapper(PTRACE_SETFPREGS, m_thread.GetID(),
194b9c1b51eSKate Stone                                            nullptr, buf, buf_size);
195068f8a7eSTamas Berghammer }
196