strafe-client/src/runner/cframe.rs

use super::vector3::Vector3;

#[derive(Clone,Copy)]
pub struct CFrame(pub(crate)glam::Affine3A);

impl CFrame{
	pub fn new(
		x:f32,y:f32,z:f32,
		xx:f32,yx:f32,zx:f32,
		xy:f32,yy:f32,zy:f32,
		xz:f32,yz:f32,zz:f32,
	)->Self{
		Self(glam::Affine3A::from_mat3_translation(
			glam::mat3(
				glam::vec3(xx,yx,zx),
				glam::vec3(xy,yy,zy),
				glam::vec3(xz,yz,zz)
			),
			glam::vec3(x,y,z)
		))
	}
	pub fn point(x:f32,y:f32,z:f32)->Self{
		Self(glam::Affine3A::from_translation(glam::vec3(x,y,z)))
	}
	pub fn angles(x:f32,y:f32,z:f32)->Self{
		Self(glam::Affine3A::from_mat3(glam::Mat3::from_euler(glam::EulerRot::YXZ,y,x,z)))
	}
}

fn vec3_to_glam(v:glam::Vec3A)->rbx_types::Vector3{
	rbx_types::Vector3::new(v.x,v.y,v.z)
}
fn vec3_from_glam(v:rbx_types::Vector3)->glam::Vec3A{
	glam::vec3a(v.x,v.y,v.z)
}

impl Into<rbx_types::CFrame> for CFrame{
	fn into(self)->rbx_types::CFrame{
		rbx_types::CFrame::new(
			vec3_to_glam(self.0.translation),
			rbx_types::Matrix3::new(
				vec3_to_glam(self.0.matrix3.x_axis),
				vec3_to_glam(self.0.matrix3.y_axis),
				vec3_to_glam(self.0.matrix3.z_axis),
			)
		)
	}
}
impl From<rbx_types::CFrame> for CFrame{
	fn from(value:rbx_types::CFrame)->Self{
		CFrame(glam::Affine3A{
			matrix3:glam::mat3a(
				vec3_from_glam(value.orientation.x),
				vec3_from_glam(value.orientation.y),
				vec3_from_glam(value.orientation.z),
			),
			translation:vec3_from_glam(value.position)
		})
	}
}

pub fn set_globals(lua:&mlua::Lua,globals:&mlua::Table)->Result<(),mlua::Error>{
	let cframe_table=lua.create_table()?;

	//CFrame.new
	cframe_table.raw_set("new",
		lua.create_function(|_,tuple:(
			mlua::Value,mlua::Value,Option<f32>,
			Option<f32>,Option<f32>,Option<f32>,
			Option<f32>,Option<f32>,Option<f32>,
			Option<f32>,Option<f32>,Option<f32>,
		)|match tuple{
			//CFrame.new(pos)
			(
				mlua::Value::UserData(pos),mlua::Value::Nil,None,
				None,None,None,
				None,None,None,
				None,None,None,
			)=>{
				let pos:Vector3=pos.take()?;
				Ok(CFrame::point(pos.0.x,pos.0.y,pos.0.z))
			},
			//TODO: CFrame.new(pos,look)
			(
				mlua::Value::UserData(pos),mlua::Value::UserData(look),None,
				None,None,None,
				None,None,None,
				None,None,None,
			)=>{
				let _pos:Vector3=pos.take()?;
				let _look:Vector3=look.take()?;
				Err(mlua::Error::runtime("Not yet implemented"))
			},
			//CFrame.new(x,y,z)
			(
				mlua::Value::Number(x),mlua::Value::Number(y),Some(z),
				None,None,None,
				None,None,None,
				None,None,None,
			)=>Ok(CFrame::point(x as f32,y as f32,z)),
			//CFrame.new(x,y,z,xx,yx,zx,xy,yy,zy,xz,yz,zz)
			(
				mlua::Value::Number(x),mlua::Value::Number(y),Some(z),
				Some(xx),Some(yx),Some(zx),
				Some(xy),Some(yy),Some(zy),
				Some(xz),Some(yz),Some(zz),
			)=>Ok(CFrame::new(x as f32,y as f32,z,
				xx,yx,zx,
				xy,yy,zy,
				xz,yz,zz,
			)),
			_=>Err(mlua::Error::runtime("Invalid arguments"))
		})?
	)?;

	//CFrame.Angles
	cframe_table.raw_set("Angles",
		lua.create_function(|_,(x,y,z):(f32,f32,f32)|
			Ok(CFrame::angles(x,y,z))
		)?
	)?;

	globals.set("CFrame",cframe_table)?;

	Ok(())
}

impl mlua::UserData for CFrame{
	fn add_fields<F:mlua::UserDataFields<Self>>(fields:&mut F){
		//CFrame.p
		fields.add_field_method_get("p",|_,this|Ok(Vector3(this.0.translation)));
	}

	fn add_methods<M:mlua::UserDataMethods<Self>>(methods:&mut M){
		methods.add_method("components",|_,this,()|Ok((
			this.0.translation.x,
			this.0.translation.y,
			this.0.translation.z,
			this.0.matrix3.x_axis.x,
			this.0.matrix3.y_axis.x,
			this.0.matrix3.z_axis.x,
			this.0.matrix3.x_axis.y,
			this.0.matrix3.y_axis.y,
			this.0.matrix3.z_axis.y,
			this.0.matrix3.x_axis.z,
			this.0.matrix3.y_axis.z,
			this.0.matrix3.z_axis.z,
		)));

		//methods.add_meta_method(mlua::MetaMethod::Mul,|_,this,val:&Vector3|Ok(Vector3(this.0.matrix3*val.0+this.0.translation)));
		methods.add_meta_function(mlua::MetaMethod::Mul,|_,(this,val):(Self,Self)|Ok(Self(this.0*val.0)));
		methods.add_meta_function(mlua::MetaMethod::ToString,|_,this:Self|
			Ok(format!("CFrame.new({},{},{},{},{},{},{},{},{},{},{},{})",
				this.0.translation.x,
				this.0.translation.y,
				this.0.translation.z,
				this.0.matrix3.x_axis.x,
				this.0.matrix3.y_axis.x,
				this.0.matrix3.z_axis.x,
				this.0.matrix3.x_axis.y,
				this.0.matrix3.y_axis.y,
				this.0.matrix3.z_axis.y,
				this.0.matrix3.x_axis.z,
				this.0.matrix3.y_axis.z,
				this.0.matrix3.z_axis.z,
			))
		);
	}
}

type_from_lua_userdata!(CFrame);