further ffi cleanup

This commit is contained in:
Bennet Bleßmann
2025-02-17 21:23:08 +01:00
committed by Bennet Bleßmann
parent f738b42e49
commit cf51338a77

View File

@@ -29,13 +29,13 @@ use libffi::middle::{Arg, Cif, CodePtr, Type};
use libloading::{Library, Symbol}; use libloading::{Library, Symbol};
use ordered_float::OrderedFloat; use ordered_float::OrderedFloat;
use std::alloc::{self, Layout}; use std::alloc::{self, Layout};
use std::any::Any;
use std::collections::HashMap; use std::collections::HashMap;
use std::error::Error; use std::error::Error;
use std::ffi::{c_void, CString}; use std::ffi::{c_void, CString};
use std::fmt::Debug; use std::fmt::Debug;
use std::marker::PhantomData; use std::marker::PhantomData;
use std::ops::Deref; use std::ops::Deref;
use std::ptr::NonNull;
pub struct FunctionDefinition { pub struct FunctionDefinition {
pub name: String, pub name: String,
@@ -66,7 +66,7 @@ struct StructImpl {
struct PointerArgs<'a, 'val> { struct PointerArgs<'a, 'val> {
memory: Vec<Arg>, memory: Vec<Arg>,
phantom: PhantomData<&'a mut ArgValues<'val>>, phantom: PhantomData<&'a mut ArgValue<'val>>,
} }
impl Deref for PointerArgs<'_, '_> { impl Deref for PointerArgs<'_, '_> {
@@ -77,7 +77,7 @@ impl Deref for PointerArgs<'_, '_> {
} }
} }
enum ArgValues<'a> { enum ArgValue<'a> {
U8(u8), U8(u8),
I8(i8), I8(i8),
U16(u16), U16(u16),
@@ -89,14 +89,14 @@ enum ArgValues<'a> {
F32(f32), F32(f32),
F64(f64), F64(f64),
Ptr(*mut c_void, PhantomData<&'a CString>), Ptr(*mut c_void, PhantomData<&'a CString>),
Struct(Box<dyn Any>), Struct(FfiStruct),
} }
impl<'val> ArgValues<'val> { impl<'val> ArgValue<'val> {
fn new( fn new(
val: &'val mut Value, val: &'val mut Value,
arg_type: &Type, arg_type: &Type,
structs_table: &mut HashMap<String, StructImpl>, structs_table: &HashMap<String, StructImpl>,
) -> Result<Self, FFIError> { ) -> Result<Self, FFIError> {
match (unsafe { *arg_type.as_raw_ptr() }).type_ as u32 { match (unsafe { *arg_type.as_raw_ptr() }).type_ as u32 {
libffi::raw::FFI_TYPE_UINT8 => Ok(Self::U8(val.as_int()?)), libffi::raw::FFI_TYPE_UINT8 => Ok(Self::U8(val.as_int()?)),
@@ -110,12 +110,49 @@ impl<'val> ArgValues<'val> {
libffi::raw::FFI_TYPE_FLOAT => Ok(Self::F32(val.as_float()? as f32)), libffi::raw::FFI_TYPE_FLOAT => Ok(Self::F32(val.as_float()? as f32)),
libffi::raw::FFI_TYPE_DOUBLE => Ok(Self::F64(val.as_float()?)), libffi::raw::FFI_TYPE_DOUBLE => Ok(Self::F64(val.as_float()?)),
libffi::raw::FFI_TYPE_POINTER => Ok(Self::Ptr(val.as_ptr()?, PhantomData)), libffi::raw::FFI_TYPE_POINTER => Ok(Self::Ptr(val.as_ptr()?, PhantomData)),
libffi::raw::FFI_TYPE_STRUCT => Ok(Self::Struct( libffi::raw::FFI_TYPE_STRUCT => Ok(Self::Struct(ForeignFunctionTable::build_struct(
ForeignFunctionTable::build_struct(val, structs_table)?.0, val,
)), structs_table,
)?)),
_ => Err(FFIError::InvalidFFIType), _ => Err(FFIError::InvalidFFIType),
} }
} }
fn build_args(
args: &'val mut [Value],
types: &[Type],
structs_table: &HashMap<String, StructImpl>,
) -> Result<Vec<Self>, FFIError> {
if types.len() != args.len() {
return Err(FFIError::ArgCountMismatch);
}
args.iter_mut()
.zip(types)
.map(|(arg, arg_type)| ArgValue::new(arg, arg_type, structs_table))
.collect::<Result<Vec<_>, _>>()
}
}
struct FfiStruct {
ptr: NonNull<c_void>,
layout: Layout,
}
impl FfiStruct {
fn new(layout: Layout) -> Result<Self, FFIError> {
if let Some(ptr) = NonNull::new(unsafe { alloc::alloc(layout) as *mut c_void }) {
Ok(FfiStruct { ptr, layout })
} else {
Err(FFIError::AllocationFailed)
}
}
}
impl Drop for FfiStruct {
fn drop(&mut self) {
unsafe { alloc::dealloc(self.ptr.as_ptr().cast(), self.layout) };
}
} }
impl ForeignFunctionTable { impl ForeignFunctionTable {
@@ -187,8 +224,7 @@ impl ForeignFunctionTable {
let library = Library::new(library_name)?; let library = Library::new(library_name)?;
for function in functions { for function in functions {
let symbol_name: CString = CString::new(function.name.clone())?; let symbol_name: CString = CString::new(function.name.clone())?;
let code_ptr: Symbol<*mut c_void> = let code_ptr: Symbol<*mut c_void> = library.get(symbol_name.as_bytes_with_nul())?;
library.get(&symbol_name.into_bytes_with_nul())?;
let args: Vec<_> = function let args: Vec<_> = function
.args .args
.iter() .iter()
@@ -196,7 +232,7 @@ impl ForeignFunctionTable {
.collect::<Result<_, _>>()?; .collect::<Result<_, _>>()?;
let result = self.map_type_ffi(&function.return_value)?; let result = self.map_type_ffi(&function.return_value)?;
let cif = libffi::middle::Cif::new(args.clone(), result.clone()); let cif = libffi::middle::Cif::new(args.iter().cloned(), result.clone());
let return_struct_name = let return_struct_name =
if (*result.as_raw_ptr()).type_ as u32 == libffi::raw::FFI_TYPE_STRUCT { if (*result.as_raw_ptr()).type_ as u32 == libffi::raw::FFI_TYPE_STRUCT {
@@ -221,25 +257,23 @@ impl ForeignFunctionTable {
Ok(()) Ok(())
} }
fn build_pointer_args<'args, 'val>(args: &[ArgValues<'val>]) -> PointerArgs<'args, 'val> { fn build_pointer_args<'args, 'val>(args: &[ArgValue<'val>]) -> PointerArgs<'args, 'val> {
let args = args let args = args
.iter() .iter()
.map(|arg| match arg { .map(|arg| match arg {
ArgValues::U8(a) => libffi::middle::arg(a), ArgValue::U8(a) => libffi::middle::arg(a),
ArgValues::I8(a) => libffi::middle::arg(a), ArgValue::I8(a) => libffi::middle::arg(a),
ArgValues::U16(a) => libffi::middle::arg(a), ArgValue::U16(a) => libffi::middle::arg(a),
ArgValues::I16(a) => libffi::middle::arg(a), ArgValue::I16(a) => libffi::middle::arg(a),
ArgValues::U32(a) => libffi::middle::arg(a), ArgValue::U32(a) => libffi::middle::arg(a),
ArgValues::I32(a) => libffi::middle::arg(a), ArgValue::I32(a) => libffi::middle::arg(a),
ArgValues::U64(a) => libffi::middle::arg(a), ArgValue::U64(a) => libffi::middle::arg(a),
ArgValues::I64(a) => libffi::middle::arg(a), ArgValue::I64(a) => libffi::middle::arg(a),
ArgValues::F32(a) => libffi::middle::arg(a), ArgValue::F32(a) => libffi::middle::arg(a),
ArgValues::F64(a) => libffi::middle::arg(a), ArgValue::F64(a) => libffi::middle::arg(a),
ArgValues::Ptr(ptr, _) => unsafe { std::mem::transmute::<*mut c_void, Arg>(*ptr) }, ArgValue::Ptr(ptr, _) => unsafe { std::mem::transmute::<*mut c_void, Arg>(*ptr) },
ArgValues::Struct(s) => unsafe { ArgValue::Struct(s) => unsafe {
std::mem::transmute::<*const c_void, Arg>( std::mem::transmute::<*mut c_void, Arg>(s.ptr.as_ptr())
s.as_ref() as *const _ as *const c_void
)
}, },
}) })
.collect(); .collect();
@@ -252,94 +286,78 @@ impl ForeignFunctionTable {
fn build_struct( fn build_struct(
arg: &mut Value, arg: &mut Value,
structs_table: &mut HashMap<String, StructImpl>, structs_table: &HashMap<String, StructImpl>,
) -> Result<(Box<dyn Any>, usize, usize), FFIError> { ) -> Result<FfiStruct, FFIError> {
match arg { let Value::Struct(ref name, ref mut struct_args) = arg else {
Value::Struct(ref name, ref mut struct_args) => { return Err(FFIError::ValueCast);
if let Some(ref mut struct_type) = structs_table.clone().get_mut(name) { };
let Some(struct_type) = structs_table.get(name) else {
return Err(FFIError::InvalidStructName);
};
let args = ArgValue::build_args(struct_args, &struct_type.fields, structs_table)?;
let ffi_type = unsafe { *struct_type.ffi_type.as_raw_ptr() }; let ffi_type = unsafe { *struct_type.ffi_type.as_raw_ptr() };
let layout =
Layout::from_size_align(ffi_type.size, ffi_type.alignment.into()).unwrap();
let align = ffi_type.alignment as usize;
let size = ffi_type.size;
let ptr = unsafe { alloc::alloc(layout) as *mut c_void };
if ptr.is_null() { let alloc = FfiStruct::new(
panic!("allocation failed") Layout::from_size_align(ffi_type.size, ffi_type.alignment.into()).unwrap(),
)?;
let Ok(mut current_layout) = Layout::from_size_align(0, 1) else {
return Err(FFIError::AllocationFailed);
};
unsafe fn write_primitive<T>(
ptr: NonNull<c_void>,
layout: &mut Layout,
val: T,
) -> Result<(), FFIError> {
let (new_layout, offset) = layout
.extend(Layout::new::<T>())
.map_err(|_| FFIError::AllocationFailed)?;
*layout = new_layout;
ptr.byte_offset(offset as isize).cast::<T>().write(val);
Ok(())
} }
let mut field_ptr = ptr; for arg in args {
#[allow(clippy::needless_range_loop)]
for i in 0..(struct_type.fields.len() - 1) {
macro_rules! try_write_int {
($type:ty) => {{
field_ptr = field_ptr
.add(field_ptr.align_offset(std::mem::align_of::<$type>()));
let n: $type = struct_args[i].as_int()?;
std::ptr::write(field_ptr as *mut $type, n);
field_ptr = field_ptr.add(std::mem::size_of::<$type>());
}};
}
macro_rules! write {
($type:ty, $value:expr) => {{
let data: $type = $value;
std::ptr::write(field_ptr as *mut $type, data);
field_ptr = field_ptr.add(align);
}};
}
let field = &struct_type.fields[i];
unsafe { unsafe {
#[allow(clippy::wildcard_in_or_patterns)] match arg {
match (*field.as_raw_ptr()).type_ as u32 { ArgValue::U8(i) => write_primitive(alloc.ptr, &mut current_layout, i)?,
libffi::raw::FFI_TYPE_UINT8 => try_write_int!(u8), ArgValue::I8(i) => write_primitive(alloc.ptr, &mut current_layout, i)?,
libffi::raw::FFI_TYPE_SINT8 => try_write_int!(i8), ArgValue::U16(i) => write_primitive(alloc.ptr, &mut current_layout, i)?,
libffi::raw::FFI_TYPE_UINT16 => try_write_int!(u16), ArgValue::I16(i) => write_primitive(alloc.ptr, &mut current_layout, i)?,
libffi::raw::FFI_TYPE_SINT16 => try_write_int!(i16), ArgValue::U32(i) => write_primitive(alloc.ptr, &mut current_layout, i)?,
libffi::raw::FFI_TYPE_UINT32 => try_write_int!(u32), ArgValue::I32(i) => write_primitive(alloc.ptr, &mut current_layout, i)?,
libffi::raw::FFI_TYPE_SINT32 => try_write_int!(i32), ArgValue::U64(i) => write_primitive(alloc.ptr, &mut current_layout, i)?,
libffi::raw::FFI_TYPE_UINT64 => try_write_int!(u64), ArgValue::I64(i) => write_primitive(alloc.ptr, &mut current_layout, i)?,
libffi::raw::FFI_TYPE_SINT64 => try_write_int!(i64), ArgValue::F32(f) => write_primitive(alloc.ptr, &mut current_layout, f)?,
libffi::raw::FFI_TYPE_POINTER => { ArgValue::F64(f) => write_primitive(alloc.ptr, &mut current_layout, f)?,
write!(*mut c_void, struct_args[i].as_ptr()?) ArgValue::Ptr(p, _) => write_primitive(alloc.ptr, &mut current_layout, p)?,
} ArgValue::Struct(arg) => {
libffi::raw::FFI_TYPE_FLOAT => { let Ok((new_layout, offset)) = current_layout.extend(arg.layout) else {
write!(f32, struct_args[i].as_float()? as f32) return Err(FFIError::AllocationFailed);
} };
libffi::raw::FFI_TYPE_DOUBLE => {
write!(f64, struct_args[i].as_float()?) current_layout = new_layout;
}
libffi::raw::FFI_TYPE_STRUCT => {
let (struct_ptr, struct_size, struct_align) =
Self::build_struct(&mut struct_args[i], structs_table)?;
field_ptr = field_ptr.add(field_ptr.align_offset(struct_align));
std::ptr::copy( std::ptr::copy(
&*struct_ptr as *const _ as *const c_void, arg.ptr.as_ptr(),
field_ptr, alloc.ptr.byte_offset(offset as isize).as_ptr(),
struct_size, arg.layout.size(),
); );
field_ptr = field_ptr.add(struct_size);
} }
libffi::raw::FFI_TYPE_VOID
| libffi::raw::FFI_TYPE_INT
| libffi::raw::FFI_TYPE_LONGDOUBLE
| libffi::raw::FFI_TYPE_COMPLEX
| _ => return Err(FFIError::InvalidFFIType),
} }
} }
} }
#[allow(clippy::from_raw_with_void_ptr)] if alloc.layout != current_layout.pad_to_align() {
Ok((unsafe { Box::from_raw(ptr) }, size, align)) // sanity check
} else { return Err(FFIError::AllocationFailed);
Err(FFIError::InvalidStructName)
}
}
_ => Err(FFIError::ValueCast),
} }
Ok(alloc)
} }
pub fn exec( pub fn exec(
@@ -348,16 +366,9 @@ impl ForeignFunctionTable {
mut args: Vec<Value>, mut args: Vec<Value>,
arena: &mut Arena, arena: &mut Arena,
) -> Result<Value, FFIError> { ) -> Result<Value, FFIError> {
let function_impl = self.table.get_mut(name).ok_or(FFIError::FunctionNotFound)?; let function_impl = self.table.get(name).ok_or(FFIError::FunctionNotFound)?;
if function_impl.args.len() != args.len() {
return Err(FFIError::ArgCountMismatch);
}
let args = args let args = ArgValue::build_args(&mut args, &function_impl.args, &self.structs)?;
.iter_mut()
.zip(function_impl.args.iter())
.map(|(arg, arg_type)| ArgValues::new(arg, arg_type, &mut self.structs))
.collect::<Result<Vec<_>, _>>()?;
let args = Self::build_pointer_args(&args); let args = Self::build_pointer_args(&args);
@@ -409,19 +420,17 @@ impl ForeignFunctionTable {
libffi::raw::FFI_TYPE_FLOAT => unsafe { call_and_return_float!(f32) }, libffi::raw::FFI_TYPE_FLOAT => unsafe { call_and_return_float!(f32) },
libffi::raw::FFI_TYPE_DOUBLE => unsafe { call_and_return_float!(f64) }, libffi::raw::FFI_TYPE_DOUBLE => unsafe { call_and_return_float!(f64) },
libffi::raw::FFI_TYPE_STRUCT => { libffi::raw::FFI_TYPE_STRUCT => {
let name = &function_impl let name = function_impl
.return_struct_name .return_struct_name
.clone() .as_ref()
.ok_or(FFIError::StructNotFound)?; .ok_or(FFIError::StructNotFound)?;
let struct_type = self.structs.get(name).ok_or(FFIError::StructNotFound)?; let struct_type = self.structs.get(name).ok_or(FFIError::StructNotFound)?;
let ffi_type = unsafe { *struct_type.ffi_type.as_raw_ptr() }; let ffi_type = unsafe { *struct_type.ffi_type.as_raw_ptr() };
let layout = let layout =
Layout::from_size_align(ffi_type.size, ffi_type.alignment.into()).unwrap(); Layout::from_size_align(ffi_type.size, ffi_type.alignment.into()).unwrap();
let ptr = unsafe { alloc::alloc(layout) };
if ptr.is_null() { let alloc = FfiStruct::new(layout)?;
return Err(FFIError::AllocationFailed);
}
let ptr_args: &[Arg] = &args; let ptr_args: &[Arg] = &args;
@@ -429,13 +438,14 @@ impl ForeignFunctionTable {
libffi::raw::ffi_call( libffi::raw::ffi_call(
function_impl.cif.as_raw_ptr(), function_impl.cif.as_raw_ptr(),
Some(*function_impl.code_ptr.as_safe_fun()), Some(*function_impl.code_ptr.as_safe_fun()),
ptr as *mut c_void, alloc.ptr.as_ptr(),
ptr_args.as_ptr() as *mut *mut c_void, ptr_args.as_ptr() as *mut *mut c_void,
) )
}; };
let struct_val = self.read_struct(ptr as *mut c_void, name, struct_type, arena); let struct_val = self.read_struct(alloc.ptr.as_ptr(), name, struct_type, arena);
drop(alloc);
unsafe { alloc::dealloc(ptr, layout) };
struct_val struct_val
} }
_ => unreachable!(), _ => unreachable!(),