#include <darwintest.h>
#include <stdbool.h>
#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include <mach/mach.h>
#include <mach/thread_status.h>
#include <mach/exception.h>
#include <pthread.h>
#if __has_feature(ptrauth_calls)
#include <ptrauth.h>
#endif
T_GLOBAL_META(T_META_RUN_CONCURRENTLY(true));
#define FPCR_DIV_EXC 0x200
static volatile bool mach_exc_caught = false;
extern boolean_t mach_exc_server(mach_msg_header_t *, mach_msg_header_t *);
kern_return_t
catch_mach_exception_raise(
mach_port_t exception_port,
mach_port_t thread,
mach_port_t task,
exception_type_t type,
exception_data_t codes,
mach_msg_type_number_t code_count)
{
#pragma unused(exception_port, thread, task, type, codes, code_count)
T_FAIL("Triggered catch_mach_exception_raise() which shouldn't happen...");
__builtin_unreachable();
}
kern_return_t
catch_mach_exception_raise_state(
mach_port_t exception_port,
exception_type_t type,
exception_data_t codes,
mach_msg_type_number_t code_count,
int *flavor,
thread_state_t in_state,
mach_msg_type_number_t in_state_count,
thread_state_t out_state,
mach_msg_type_number_t *out_state_count)
{
#pragma unused(exception_port, type, codes, code_count, flavor, in_state, in_state_count, out_state, out_state_count)
#ifdef __arm64__
T_LOG("Caught a mach exception!\n");
T_ASSERT_EQ(type, EXC_ARITHMETIC, "Caught an EXC_ARITHMETIC exception");
T_ASSERT_EQ(code_count, 2, "Two code values were provided with the mach exception");
uint64_t *codes_64 = (uint64_t*)codes;
T_LOG("Mach exception codes[0]: %#llx, codes[1]: %#llx\n", codes_64[0], codes_64[1]);
T_ASSERT_EQ(*flavor, ARM_THREAD_STATE64, "The thread state flavor is ARM_THREAD_STATE64");
T_ASSERT_EQ(in_state_count, ARM_THREAD_STATE64_COUNT, "The thread state count is ARM_THREAD_STATE64_COUNT");
T_ASSERT_EQ(codes_64[0], EXC_ARM_FP_DZ, "The subcode is EXC_ARM_FP_DZ (floating point divide-by-zero)");
*out_state_count = in_state_count;
memcpy((void*)out_state, (void*)in_state, in_state_count * 4);
arm_thread_state64_t *state = (arm_thread_state64_t*)out_state;
void *pc = (void*)(arm_thread_state64_get_pc(*state) + 4);
#if __has_feature(ptrauth_calls)
pc = ptrauth_sign_unauthenticated(pc, ptrauth_key_function_pointer, 0);
#endif
arm_thread_state64_set_pc_fptr(*state, pc);
mach_exc_caught = true;
#endif
return KERN_SUCCESS;
}
kern_return_t
catch_mach_exception_raise_state_identity(
mach_port_t exception_port,
mach_port_t thread,
mach_port_t task,
exception_type_t type,
exception_data_t codes,
mach_msg_type_number_t code_count,
int *flavor,
thread_state_t in_state,
mach_msg_type_number_t in_state_count,
thread_state_t out_state,
mach_msg_type_number_t *out_state_count)
{
#pragma unused(exception_port, thread, task, type, codes, code_count, flavor, in_state, in_state_count, out_state, out_state_count)
T_FAIL("Triggered catch_mach_exception_raise_state_identity() which shouldn't happen...");
__builtin_unreachable();
}
void *
exc_server_thread(void *arg)
{
mach_port_t exc_port = *(mach_port_t*)arg;
#define MACH_MSG_REPLY_SIZE 4096
kern_return_t kr = mach_msg_server_once(mach_exc_server, MACH_MSG_REPLY_SIZE, exc_port, 0);
T_ASSERT_MACH_SUCCESS(kr, "Received mach exception message");
pthread_exit((void*)0);
__builtin_unreachable();
}
T_DECL(armv8_fp_exception,
"Test that ARMv8 floating point exceptions generate mach exceptions.")
{
#ifndef __arm64__
T_SKIP("Running on non-arm64 target, skipping...");
#else
pthread_t exc_thread;
mach_port_t exc_port = MACH_PORT_NULL;
mach_port_t task = mach_task_self();
mach_port_t thread = mach_thread_self();
kern_return_t kr = KERN_SUCCESS;
uint64_t fpcr = __builtin_arm_rsr64("FPCR") | FPCR_DIV_EXC;
__builtin_arm_wsr64("FPCR", fpcr);
#define DSB_ISH 0xb
__builtin_arm_dsb(DSB_ISH);
if (__builtin_arm_rsr64("FPCR") != fpcr) {
T_SKIP("Running on a device that doesn't support floating point exceptions, skipping...");
}
kr = mach_port_allocate(task, MACH_PORT_RIGHT_RECEIVE, &exc_port);
T_ASSERT_MACH_SUCCESS(kr, "Allocated mach exception port");
kr = mach_port_insert_right(task, exc_port, exc_port, MACH_MSG_TYPE_MAKE_SEND);
T_ASSERT_MACH_SUCCESS(kr, "Inserted a SEND right into the exception port");
kr = thread_set_exception_ports(
thread,
EXC_MASK_ARITHMETIC,
exc_port,
EXCEPTION_STATE | MACH_EXCEPTION_CODES,
ARM_THREAD_STATE64);
T_ASSERT_MACH_SUCCESS(kr, "Set the exception port to my custom handler");
int err = pthread_create(&exc_thread, (pthread_attr_t*)0, exc_server_thread, (void*)&exc_port);
T_ASSERT_POSIX_ZERO(err, "Spawned exception server thread");
pthread_detach(exc_thread);
float a = 6.5f;
float b = 0.0f;
__asm volatile ("fdiv %s0, %s1, %s2" : "=w" (a) : "w" (a), "w" (b));
if (mach_exc_caught) {
T_PASS("The expected floating point divide-by-zero exception was caught!");
} else {
T_FAIL("The floating point divide-by-zero exception was not captured :(");
}
#endif
}