playback get_position_angles

lib/src/head.rs

@@ -1,3 +1,4 @@
+use glam::Vec3Swizzles;
 use strafesnet_common::timer::{Timer,Scaled};
 use strafesnet_common::session::{Time as SessionTime,TimeInner as SessionTimeInner};
 use strafesnet_common::physics::{Time as PhysicsTime,TimeInner as PhysicsTimeInner};
@@ -10,6 +11,10 @@ pub enum PlaybackInstructionExternal{
 	Idle,
 }
 
+fn vector3_to_glam(v:&strafesnet_roblox_bot_file::v0::Vector3)->glam::Vec3{
+	glam::vec3(v.x,v.y,v.z)
+}
+
 /// A playback context.  Advance time and then generate a camera position to pass to the renderer.
 pub struct PlaybackHead{
 	//"Simulation"
@@ -47,4 +52,30 @@ impl PlaybackHead{
 			}
 		}
 	}
+	pub fn get_position_angles(&self,bot:&crate::bot::Bot,time:SessionTime)->(glam::Vec3,glam::Vec2){
+		let time=self.timer.time(time);
+		let event0=&bot.timelines().output_events[self.event_id];
+		let event1=&bot.timelines().output_events[self.event_id+1];
+		let p0=vector3_to_glam(&event0.event.position);
+		let p1=vector3_to_glam(&event1.event.position);
+		// let v0=vector3_to_glam(&event0.event.velocity);
+		// let v1=vector3_to_glam(&event1.event.velocity);
+		// let a0=vector3_to_glam(&event0.event.acceleration);
+		// let a1=vector3_to_glam(&event1.event.acceleration);
+		let t0=event0.time;
+		let t1=event1.time;
+		let time_float=time.get() as f64/PhysicsTime::ONE_SECOND.get() as f64;
+		let t=((time_float+self.offset-t0)/(t1-t0)) as f32;
+		let p=p0.lerp(p1,t);
+		// let v=v0.lerp(v1,t);
+		// let a=a0.lerp(a1,t);
+
+		//println!("position={:?}",p);
+
+		let angles0=vector3_to_glam(&event0.event.angles);
+		let angles1=vector3_to_glam(&event1.event.angles);
+		let angles=angles0.lerp(angles1,t);
+
+		(p,-angles.yx())
+	}
 }