1*80814287SRaphael 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 
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 
37e46c6644SGuilherme Andrade   return DoReadRegisterValue(GetPtraceOffset(reg_index), 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 
94e46c6644SGuilherme Andrade   return DoWriteRegisterValue(GetPtraceOffset(reg_index), reg_info->name,
95e46c6644SGuilherme Andrade                               reg_value);
96068f8a7eSTamas Berghammer }
97068f8a7eSTamas Berghammer 
9897206d57SZachary Turner Status NativeRegisterContextLinux::ReadGPR() {
993f3673eaSPavel Labath   return NativeProcessLinux::PtraceWrapper(
1003f3673eaSPavel Labath       PTRACE_GETREGS, m_thread.GetID(), nullptr, GetGPRBuffer(), GetGPRSize());
101068f8a7eSTamas Berghammer }
102068f8a7eSTamas Berghammer 
10397206d57SZachary Turner Status NativeRegisterContextLinux::WriteGPR() {
1043f3673eaSPavel Labath   return NativeProcessLinux::PtraceWrapper(
1053f3673eaSPavel Labath       PTRACE_SETREGS, m_thread.GetID(), nullptr, GetGPRBuffer(), GetGPRSize());
106068f8a7eSTamas Berghammer }
107068f8a7eSTamas Berghammer 
10897206d57SZachary Turner Status NativeRegisterContextLinux::ReadFPR() {
1093f3673eaSPavel Labath   return NativeProcessLinux::PtraceWrapper(PTRACE_GETFPREGS, m_thread.GetID(),
1103f3673eaSPavel Labath                                            nullptr, GetFPRBuffer(),
1113f3673eaSPavel Labath                                            GetFPRSize());
112068f8a7eSTamas Berghammer }
113068f8a7eSTamas Berghammer 
11497206d57SZachary Turner Status NativeRegisterContextLinux::WriteFPR() {
1153f3673eaSPavel Labath   return NativeProcessLinux::PtraceWrapper(PTRACE_SETFPREGS, m_thread.GetID(),
1163f3673eaSPavel Labath                                            nullptr, GetFPRBuffer(),
1173f3673eaSPavel Labath                                            GetFPRSize());
118068f8a7eSTamas Berghammer }
119068f8a7eSTamas Berghammer 
12097206d57SZachary Turner Status NativeRegisterContextLinux::ReadRegisterSet(void *buf, size_t buf_size,
121b9c1b51eSKate Stone                                                    unsigned int regset) {
1224a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(PTRACE_GETREGSET, m_thread.GetID(),
123b9c1b51eSKate Stone                                            static_cast<void *>(&regset), buf,
124b9c1b51eSKate Stone                                            buf_size);
125068f8a7eSTamas Berghammer }
126068f8a7eSTamas Berghammer 
12797206d57SZachary Turner Status NativeRegisterContextLinux::WriteRegisterSet(void *buf, size_t buf_size,
128b9c1b51eSKate Stone                                                     unsigned int regset) {
1294a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(PTRACE_SETREGSET, m_thread.GetID(),
130b9c1b51eSKate Stone                                            static_cast<void *>(&regset), buf,
131b9c1b51eSKate Stone                                            buf_size);
132068f8a7eSTamas Berghammer }
133068f8a7eSTamas Berghammer 
13497206d57SZachary Turner Status NativeRegisterContextLinux::DoReadRegisterValue(uint32_t offset,
135068f8a7eSTamas Berghammer                                                        const char *reg_name,
136068f8a7eSTamas Berghammer                                                        uint32_t size,
137b9c1b51eSKate Stone                                                        RegisterValue &value) {
138c7512fdcSPavel Labath   Log *log(ProcessPOSIXLog::GetLogIfAllCategoriesSet(POSIX_LOG_REGISTERS));
139c7512fdcSPavel Labath 
1404a9babb2SPavel Labath   long data;
14197206d57SZachary Turner   Status error = NativeProcessLinux::PtraceWrapper(
142b9c1b51eSKate Stone       PTRACE_PEEKUSER, m_thread.GetID(), reinterpret_cast<void *>(offset),
143b9c1b51eSKate Stone       nullptr, 0, &data);
144c7512fdcSPavel Labath 
145c7512fdcSPavel Labath   if (error.Success())
1461bd3c9abSChaoren Lin     // First cast to an unsigned of the same size to avoid sign extension.
147a160ae8aSNitesh Jain     value.SetUInt(static_cast<unsigned long>(data), size);
148c7512fdcSPavel Labath 
149ea1b6b17SPavel Labath   LLDB_LOG(log, "{0}: {1:x}", reg_name, data);
150c7512fdcSPavel Labath   return error;
151068f8a7eSTamas Berghammer }
152068f8a7eSTamas Berghammer 
15397206d57SZachary Turner Status NativeRegisterContextLinux::DoWriteRegisterValue(
154b9c1b51eSKate Stone     uint32_t offset, const char *reg_name, const RegisterValue &value) {
155c7512fdcSPavel Labath   Log *log(ProcessPOSIXLog::GetLogIfAllCategoriesSet(POSIX_LOG_REGISTERS));
156c7512fdcSPavel Labath 
157c7512fdcSPavel Labath   void *buf = reinterpret_cast<void *>(value.GetAsUInt64());
158ea1b6b17SPavel Labath   LLDB_LOG(log, "{0}: {1}", reg_name, buf);
159c7512fdcSPavel Labath 
1604a9babb2SPavel Labath   return NativeProcessLinux::PtraceWrapper(
1614a9babb2SPavel Labath       PTRACE_POKEUSER, m_thread.GetID(), reinterpret_cast<void *>(offset), buf);
162068f8a7eSTamas Berghammer }
163