1be691f3bSpatrick //===-- NativeRegisterContextFreeBSD_arm64.cpp ----------------------------===//
2be691f3bSpatrick //
3be691f3bSpatrick // Part of the LLVM Project, under the Apache License v2.0 with LLVM Exceptions.
4be691f3bSpatrick // See https://llvm.org/LICENSE.txt for license information.
5be691f3bSpatrick // SPDX-License-Identifier: Apache-2.0 WITH LLVM-exception
6be691f3bSpatrick //
7be691f3bSpatrick //===----------------------------------------------------------------------===//
8be691f3bSpatrick
9be691f3bSpatrick #if defined(__aarch64__)
10be691f3bSpatrick
11be691f3bSpatrick #include "NativeRegisterContextFreeBSD_arm64.h"
12be691f3bSpatrick
13be691f3bSpatrick #include "lldb/Utility/DataBufferHeap.h"
14be691f3bSpatrick #include "lldb/Utility/RegisterValue.h"
15be691f3bSpatrick #include "lldb/Utility/Status.h"
16be691f3bSpatrick
17be691f3bSpatrick #include "Plugins/Process/FreeBSD/NativeProcessFreeBSD.h"
18be691f3bSpatrick #include "Plugins/Process/POSIX/ProcessPOSIXLog.h"
19be691f3bSpatrick #include "Plugins/Process/Utility/RegisterInfoPOSIX_arm64.h"
20be691f3bSpatrick
21be691f3bSpatrick // clang-format off
22be691f3bSpatrick #include <sys/param.h>
23be691f3bSpatrick #include <sys/ptrace.h>
24be691f3bSpatrick #include <sys/types.h>
25be691f3bSpatrick // clang-format on
26be691f3bSpatrick
27be691f3bSpatrick using namespace lldb;
28be691f3bSpatrick using namespace lldb_private;
29be691f3bSpatrick using namespace lldb_private::process_freebsd;
30be691f3bSpatrick
31be691f3bSpatrick NativeRegisterContextFreeBSD *
CreateHostNativeRegisterContextFreeBSD(const ArchSpec & target_arch,NativeThreadProtocol & native_thread)32be691f3bSpatrick NativeRegisterContextFreeBSD::CreateHostNativeRegisterContextFreeBSD(
33be691f3bSpatrick const ArchSpec &target_arch, NativeThreadProtocol &native_thread) {
34be691f3bSpatrick return new NativeRegisterContextFreeBSD_arm64(target_arch, native_thread);
35be691f3bSpatrick }
36be691f3bSpatrick
NativeRegisterContextFreeBSD_arm64(const ArchSpec & target_arch,NativeThreadProtocol & native_thread)37be691f3bSpatrick NativeRegisterContextFreeBSD_arm64::NativeRegisterContextFreeBSD_arm64(
38be691f3bSpatrick const ArchSpec &target_arch, NativeThreadProtocol &native_thread)
39be691f3bSpatrick : NativeRegisterContextRegisterInfo(
40be691f3bSpatrick native_thread, new RegisterInfoPOSIX_arm64(target_arch, 0))
41be691f3bSpatrick #ifdef LLDB_HAS_FREEBSD_WATCHPOINT
42be691f3bSpatrick ,
43be691f3bSpatrick m_read_dbreg(false)
44be691f3bSpatrick #endif
45be691f3bSpatrick {
46be691f3bSpatrick ::memset(&m_hwp_regs, 0, sizeof(m_hwp_regs));
47be691f3bSpatrick ::memset(&m_hbp_regs, 0, sizeof(m_hbp_regs));
48be691f3bSpatrick }
49be691f3bSpatrick
50be691f3bSpatrick RegisterInfoPOSIX_arm64 &
GetRegisterInfo() const51be691f3bSpatrick NativeRegisterContextFreeBSD_arm64::GetRegisterInfo() const {
52be691f3bSpatrick return static_cast<RegisterInfoPOSIX_arm64 &>(*m_register_info_interface_up);
53be691f3bSpatrick }
54be691f3bSpatrick
GetRegisterSetCount() const55be691f3bSpatrick uint32_t NativeRegisterContextFreeBSD_arm64::GetRegisterSetCount() const {
56be691f3bSpatrick return GetRegisterInfo().GetRegisterSetCount();
57be691f3bSpatrick }
58be691f3bSpatrick
59be691f3bSpatrick const RegisterSet *
GetRegisterSet(uint32_t set_index) const60be691f3bSpatrick NativeRegisterContextFreeBSD_arm64::GetRegisterSet(uint32_t set_index) const {
61be691f3bSpatrick return GetRegisterInfo().GetRegisterSet(set_index);
62be691f3bSpatrick }
63be691f3bSpatrick
GetUserRegisterCount() const64be691f3bSpatrick uint32_t NativeRegisterContextFreeBSD_arm64::GetUserRegisterCount() const {
65be691f3bSpatrick uint32_t count = 0;
66be691f3bSpatrick for (uint32_t set_index = 0; set_index < GetRegisterSetCount(); ++set_index)
67be691f3bSpatrick count += GetRegisterSet(set_index)->num_registers;
68be691f3bSpatrick return count;
69be691f3bSpatrick }
70be691f3bSpatrick
ReadRegisterSet(uint32_t set)71be691f3bSpatrick Status NativeRegisterContextFreeBSD_arm64::ReadRegisterSet(uint32_t set) {
72be691f3bSpatrick switch (set) {
73be691f3bSpatrick case RegisterInfoPOSIX_arm64::GPRegSet:
74be691f3bSpatrick return NativeProcessFreeBSD::PtraceWrapper(PT_GETREGS, m_thread.GetID(),
75be691f3bSpatrick m_reg_data.data());
76be691f3bSpatrick case RegisterInfoPOSIX_arm64::FPRegSet:
77be691f3bSpatrick return NativeProcessFreeBSD::PtraceWrapper(
78be691f3bSpatrick PT_GETFPREGS, m_thread.GetID(),
79be691f3bSpatrick m_reg_data.data() + sizeof(RegisterInfoPOSIX_arm64::GPR));
80be691f3bSpatrick }
81be691f3bSpatrick llvm_unreachable("NativeRegisterContextFreeBSD_arm64::ReadRegisterSet");
82be691f3bSpatrick }
83be691f3bSpatrick
WriteRegisterSet(uint32_t set)84be691f3bSpatrick Status NativeRegisterContextFreeBSD_arm64::WriteRegisterSet(uint32_t set) {
85be691f3bSpatrick switch (set) {
86be691f3bSpatrick case RegisterInfoPOSIX_arm64::GPRegSet:
87be691f3bSpatrick return NativeProcessFreeBSD::PtraceWrapper(PT_SETREGS, m_thread.GetID(),
88be691f3bSpatrick m_reg_data.data());
89be691f3bSpatrick case RegisterInfoPOSIX_arm64::FPRegSet:
90be691f3bSpatrick return NativeProcessFreeBSD::PtraceWrapper(
91be691f3bSpatrick PT_SETFPREGS, m_thread.GetID(),
92be691f3bSpatrick m_reg_data.data() + sizeof(RegisterInfoPOSIX_arm64::GPR));
93be691f3bSpatrick }
94be691f3bSpatrick llvm_unreachable("NativeRegisterContextFreeBSD_arm64::WriteRegisterSet");
95be691f3bSpatrick }
96be691f3bSpatrick
97be691f3bSpatrick Status
ReadRegister(const RegisterInfo * reg_info,RegisterValue & reg_value)98be691f3bSpatrick NativeRegisterContextFreeBSD_arm64::ReadRegister(const RegisterInfo *reg_info,
99be691f3bSpatrick RegisterValue ®_value) {
100be691f3bSpatrick Status error;
101be691f3bSpatrick
102be691f3bSpatrick if (!reg_info) {
103be691f3bSpatrick error.SetErrorString("reg_info NULL");
104be691f3bSpatrick return error;
105be691f3bSpatrick }
106be691f3bSpatrick
107be691f3bSpatrick const uint32_t reg = reg_info->kinds[lldb::eRegisterKindLLDB];
108be691f3bSpatrick
109be691f3bSpatrick if (reg == LLDB_INVALID_REGNUM)
110be691f3bSpatrick return Status("no lldb regnum for %s", reg_info && reg_info->name
111be691f3bSpatrick ? reg_info->name
112be691f3bSpatrick : "<unknown register>");
113be691f3bSpatrick
114be691f3bSpatrick uint32_t set = GetRegisterInfo().GetRegisterSetFromRegisterIndex(reg);
115be691f3bSpatrick error = ReadRegisterSet(set);
116be691f3bSpatrick if (error.Fail())
117be691f3bSpatrick return error;
118be691f3bSpatrick
119be691f3bSpatrick assert(reg_info->byte_offset + reg_info->byte_size <= m_reg_data.size());
120be691f3bSpatrick reg_value.SetBytes(m_reg_data.data() + reg_info->byte_offset,
121be691f3bSpatrick reg_info->byte_size, endian::InlHostByteOrder());
122be691f3bSpatrick return error;
123be691f3bSpatrick }
124be691f3bSpatrick
WriteRegister(const RegisterInfo * reg_info,const RegisterValue & reg_value)125be691f3bSpatrick Status NativeRegisterContextFreeBSD_arm64::WriteRegister(
126be691f3bSpatrick const RegisterInfo *reg_info, const RegisterValue ®_value) {
127be691f3bSpatrick Status error;
128be691f3bSpatrick
129be691f3bSpatrick if (!reg_info)
130be691f3bSpatrick return Status("reg_info NULL");
131be691f3bSpatrick
132be691f3bSpatrick const uint32_t reg = reg_info->kinds[lldb::eRegisterKindLLDB];
133be691f3bSpatrick
134be691f3bSpatrick if (reg == LLDB_INVALID_REGNUM)
135be691f3bSpatrick return Status("no lldb regnum for %s", reg_info && reg_info->name
136be691f3bSpatrick ? reg_info->name
137be691f3bSpatrick : "<unknown register>");
138be691f3bSpatrick
139be691f3bSpatrick uint32_t set = GetRegisterInfo().GetRegisterSetFromRegisterIndex(reg);
140be691f3bSpatrick error = ReadRegisterSet(set);
141be691f3bSpatrick if (error.Fail())
142be691f3bSpatrick return error;
143be691f3bSpatrick
144be691f3bSpatrick assert(reg_info->byte_offset + reg_info->byte_size <= m_reg_data.size());
145be691f3bSpatrick ::memcpy(m_reg_data.data() + reg_info->byte_offset, reg_value.GetBytes(),
146be691f3bSpatrick reg_info->byte_size);
147be691f3bSpatrick
148be691f3bSpatrick return WriteRegisterSet(set);
149be691f3bSpatrick }
150be691f3bSpatrick
ReadAllRegisterValues(lldb::WritableDataBufferSP & data_sp)151be691f3bSpatrick Status NativeRegisterContextFreeBSD_arm64::ReadAllRegisterValues(
152*f6aab3d8Srobert lldb::WritableDataBufferSP &data_sp) {
153be691f3bSpatrick Status error;
154be691f3bSpatrick
155be691f3bSpatrick error = ReadRegisterSet(RegisterInfoPOSIX_arm64::GPRegSet);
156be691f3bSpatrick if (error.Fail())
157be691f3bSpatrick return error;
158be691f3bSpatrick
159be691f3bSpatrick error = ReadRegisterSet(RegisterInfoPOSIX_arm64::FPRegSet);
160be691f3bSpatrick if (error.Fail())
161be691f3bSpatrick return error;
162be691f3bSpatrick
163be691f3bSpatrick data_sp.reset(new DataBufferHeap(m_reg_data.size(), 0));
164be691f3bSpatrick uint8_t *dst = data_sp->GetBytes();
165be691f3bSpatrick ::memcpy(dst, m_reg_data.data(), m_reg_data.size());
166be691f3bSpatrick
167be691f3bSpatrick return error;
168be691f3bSpatrick }
169be691f3bSpatrick
WriteAllRegisterValues(const lldb::DataBufferSP & data_sp)170be691f3bSpatrick Status NativeRegisterContextFreeBSD_arm64::WriteAllRegisterValues(
171be691f3bSpatrick const lldb::DataBufferSP &data_sp) {
172be691f3bSpatrick Status error;
173be691f3bSpatrick
174be691f3bSpatrick if (!data_sp) {
175be691f3bSpatrick error.SetErrorStringWithFormat(
176be691f3bSpatrick "NativeRegisterContextFreeBSD_arm64::%s invalid data_sp provided",
177be691f3bSpatrick __FUNCTION__);
178be691f3bSpatrick return error;
179be691f3bSpatrick }
180be691f3bSpatrick
181be691f3bSpatrick if (data_sp->GetByteSize() != m_reg_data.size()) {
182be691f3bSpatrick error.SetErrorStringWithFormat(
183be691f3bSpatrick "NativeRegisterContextFreeBSD_arm64::%s data_sp contained mismatched "
184be691f3bSpatrick "data size, expected %" PRIu64 ", actual %" PRIu64,
185be691f3bSpatrick __FUNCTION__, m_reg_data.size(), data_sp->GetByteSize());
186be691f3bSpatrick return error;
187be691f3bSpatrick }
188be691f3bSpatrick
189*f6aab3d8Srobert const uint8_t *src = data_sp->GetBytes();
190be691f3bSpatrick if (src == nullptr) {
191be691f3bSpatrick error.SetErrorStringWithFormat("NativeRegisterContextFreeBSD_arm64::%s "
192be691f3bSpatrick "DataBuffer::GetBytes() returned a null "
193be691f3bSpatrick "pointer",
194be691f3bSpatrick __FUNCTION__);
195be691f3bSpatrick return error;
196be691f3bSpatrick }
197be691f3bSpatrick ::memcpy(m_reg_data.data(), src, m_reg_data.size());
198be691f3bSpatrick
199be691f3bSpatrick error = WriteRegisterSet(RegisterInfoPOSIX_arm64::GPRegSet);
200be691f3bSpatrick if (error.Fail())
201be691f3bSpatrick return error;
202be691f3bSpatrick
203be691f3bSpatrick return WriteRegisterSet(RegisterInfoPOSIX_arm64::FPRegSet);
204be691f3bSpatrick }
205be691f3bSpatrick
CopyHardwareWatchpointsFrom(NativeRegisterContextFreeBSD & source)206be691f3bSpatrick llvm::Error NativeRegisterContextFreeBSD_arm64::CopyHardwareWatchpointsFrom(
207be691f3bSpatrick NativeRegisterContextFreeBSD &source) {
208be691f3bSpatrick #ifdef LLDB_HAS_FREEBSD_WATCHPOINT
209be691f3bSpatrick auto &r_source = static_cast<NativeRegisterContextFreeBSD_arm64 &>(source);
210be691f3bSpatrick llvm::Error error = r_source.ReadHardwareDebugInfo();
211be691f3bSpatrick if (error)
212be691f3bSpatrick return error;
213be691f3bSpatrick
214be691f3bSpatrick m_dbreg = r_source.m_dbreg;
215be691f3bSpatrick m_hbp_regs = r_source.m_hbp_regs;
216be691f3bSpatrick m_hwp_regs = r_source.m_hwp_regs;
217be691f3bSpatrick m_max_hbp_supported = r_source.m_max_hbp_supported;
218be691f3bSpatrick m_max_hwp_supported = r_source.m_max_hwp_supported;
219be691f3bSpatrick m_read_dbreg = true;
220be691f3bSpatrick
221be691f3bSpatrick // on FreeBSD this writes both breakpoints and watchpoints
222be691f3bSpatrick return WriteHardwareDebugRegs(eDREGTypeWATCH);
223be691f3bSpatrick #else
224be691f3bSpatrick return llvm::Error::success();
225be691f3bSpatrick #endif
226be691f3bSpatrick }
227be691f3bSpatrick
ReadHardwareDebugInfo()228be691f3bSpatrick llvm::Error NativeRegisterContextFreeBSD_arm64::ReadHardwareDebugInfo() {
229be691f3bSpatrick #ifdef LLDB_HAS_FREEBSD_WATCHPOINT
230*f6aab3d8Srobert Log *log = GetLog(POSIXLog::Registers);
231be691f3bSpatrick
232be691f3bSpatrick // we're fully stateful, so no need to reread control registers ever
233be691f3bSpatrick if (m_read_dbreg)
234be691f3bSpatrick return llvm::Error::success();
235be691f3bSpatrick
236be691f3bSpatrick Status res = NativeProcessFreeBSD::PtraceWrapper(PT_GETDBREGS,
237be691f3bSpatrick m_thread.GetID(), &m_dbreg);
238be691f3bSpatrick if (res.Fail())
239be691f3bSpatrick return res.ToError();
240be691f3bSpatrick
241be691f3bSpatrick LLDB_LOG(log, "m_dbreg read: debug_ver={0}, nbkpts={1}, nwtpts={2}",
242be691f3bSpatrick m_dbreg.db_debug_ver, m_dbreg.db_nbkpts, m_dbreg.db_nwtpts);
243be691f3bSpatrick m_max_hbp_supported = m_dbreg.db_nbkpts;
244be691f3bSpatrick m_max_hwp_supported = m_dbreg.db_nwtpts;
245be691f3bSpatrick assert(m_max_hbp_supported <= m_hbp_regs.size());
246be691f3bSpatrick assert(m_max_hwp_supported <= m_hwp_regs.size());
247be691f3bSpatrick
248be691f3bSpatrick m_read_dbreg = true;
249be691f3bSpatrick return llvm::Error::success();
250be691f3bSpatrick #else
251be691f3bSpatrick return llvm::createStringError(
252be691f3bSpatrick llvm::inconvertibleErrorCode(),
253be691f3bSpatrick "Hardware breakpoints/watchpoints require FreeBSD 14.0");
254be691f3bSpatrick #endif
255be691f3bSpatrick }
256be691f3bSpatrick
257be691f3bSpatrick llvm::Error
WriteHardwareDebugRegs(DREGType)258be691f3bSpatrick NativeRegisterContextFreeBSD_arm64::WriteHardwareDebugRegs(DREGType) {
259be691f3bSpatrick #ifdef LLDB_HAS_FREEBSD_WATCHPOINT
260be691f3bSpatrick assert(m_read_dbreg && "dbregs must be read before writing them back");
261be691f3bSpatrick
262be691f3bSpatrick // copy data from m_*_regs to m_dbreg before writing it back
263be691f3bSpatrick for (uint32_t i = 0; i < m_max_hbp_supported; i++) {
264be691f3bSpatrick m_dbreg.db_breakregs[i].dbr_addr = m_hbp_regs[i].address;
265be691f3bSpatrick m_dbreg.db_breakregs[i].dbr_ctrl = m_hbp_regs[i].control;
266be691f3bSpatrick }
267be691f3bSpatrick for (uint32_t i = 0; i < m_max_hwp_supported; i++) {
268be691f3bSpatrick m_dbreg.db_watchregs[i].dbw_addr = m_hwp_regs[i].address;
269be691f3bSpatrick m_dbreg.db_watchregs[i].dbw_ctrl = m_hwp_regs[i].control;
270be691f3bSpatrick }
271be691f3bSpatrick
272be691f3bSpatrick return NativeProcessFreeBSD::PtraceWrapper(PT_SETDBREGS, m_thread.GetID(),
273be691f3bSpatrick &m_dbreg)
274be691f3bSpatrick .ToError();
275be691f3bSpatrick #else
276be691f3bSpatrick return llvm::createStringError(
277be691f3bSpatrick llvm::inconvertibleErrorCode(),
278be691f3bSpatrick "Hardware breakpoints/watchpoints require FreeBSD 14.0");
279be691f3bSpatrick #endif
280be691f3bSpatrick }
281be691f3bSpatrick
282be691f3bSpatrick #endif // defined (__aarch64__)
283