diff options
Diffstat (limited to 'bindings/cs/libsurvive.net/SurviveContext.cs')
| -rw-r--r-- | bindings/cs/libsurvive.net/SurviveContext.cs | 93 |
1 files changed, 71 insertions, 22 deletions
diff --git a/bindings/cs/libsurvive.net/SurviveContext.cs b/bindings/cs/libsurvive.net/SurviveContext.cs index bafcf2b..37f67e4 100644 --- a/bindings/cs/libsurvive.net/SurviveContext.cs +++ b/bindings/cs/libsurvive.net/SurviveContext.cs @@ -1,4 +1,5 @@ using System; +using System.Collections.Generic; namespace libsurvive { @@ -8,16 +9,17 @@ namespace libsurvive public class SurviveContext : IDisposable { + public delegate void PoseUpdate(int ObjectID, Vector3 pos); + + protected IntPtr ctx; public void Dispose() { - cfunctions.survive_close(ctx); + cfunctions.Survive_close(ctx); ctx = IntPtr.Zero; } - public SurviveContext() : this(null) { } - /** * We need to keep these delegates around for the lifespan of this object. * if we just pass the functions in, it creates temporary delegates that @@ -35,11 +37,27 @@ namespace libsurvive public SurviveContext(string[] args) { + Init(args); + } + + public SurviveContext(string replaydata) + { + string[] vs = new[] { "--playback", "lightcap-reformat.log"}; + Init(vs); + } + + internal void Init(string[] args) + { string[] newArgs = new string[args.Length + 1]; newArgs[0] = System.Reflection.Assembly.GetEntryAssembly().FullName; Array.Copy(args, 0, newArgs, 1, args.Length); - ctx = cfunctions.survive_init_internal(newArgs.Length, newArgs); + ctx = cfunctions.Survive_init_internal(newArgs.Length, newArgs); + + if (ctx == IntPtr.Zero) + { + throw new Exception("There was a problem initializing the lib!"); + } light_Process_Func = LightEvent; raw_Pose_Func = PoseEvent; @@ -51,17 +69,29 @@ namespace libsurvive error_func = ErrorEvent; info_func = InfoEvent; - cfunctions.survive_install_raw_pose_fn(ctx, raw_Pose_Func); - cfunctions.survive_install_light_fn(ctx, light_Process_Func); - cfunctions.survive_install_lighthouse_pose_fn(ctx, lighthouse_Pose_Func); - cfunctions.survive_install_angle_fn(ctx, angle_Process_Func); - cfunctions.survive_install_button_fn(ctx, button_Process_Func); - cfunctions.survive_install_htc_config_fn(ctx, htc_Config_Func); - cfunctions.survive_install_imu_fn(ctx, imu_Process_Func); - cfunctions.survive_install_error_fn(ctx, error_func); - cfunctions.survive_install_info_fn(ctx, info_func); + cfunctions.Survive_install_raw_pose_fn(ctx, raw_Pose_Func); + cfunctions.Survive_install_light_fn(ctx, light_Process_Func); + cfunctions.Survive_install_lighthouse_pose_fn(ctx, lighthouse_Pose_Func); + cfunctions.Survive_install_angle_fn(ctx, angle_Process_Func); + cfunctions.Survive_install_button_fn(ctx, button_Process_Func); + cfunctions.Survive_install_htc_config_fn(ctx, htc_Config_Func); + cfunctions.Survive_install_imu_fn(ctx, imu_Process_Func); + cfunctions.Survive_install_error_fn(ctx, error_func); + cfunctions.Survive_install_info_fn(ctx, info_func); } + + //Dictionary<int,PoseUpdate> PoseUpdateCallbacks = new Dictionary<int, PoseUpdate>(); + PoseUpdate poseUpdate; + + public void AddPoseUpdateCallback(PoseUpdate update, int objectID) + { + //PoseUpdateCallbacks[objectID] += update; + poseUpdate += update; + } + + + virtual protected void InfoEvent(SurviveObjectPtr ctx, string fault) { Console.Out.WriteLine(fault); @@ -74,42 +104,61 @@ namespace libsurvive virtual protected void IMUEvent(SurviveObjectPtr so, int mask, double[] accelgyro, uint timecode, int id) { - cfunctions.survive_default_imu_process(so, mask, accelgyro, timecode, id); + cfunctions.Survive_default_imu_process(so, mask, accelgyro, timecode, id); } virtual protected int HTCConfigEvent(SurviveObjectPtr so, string ct0conf, int len) { - return cfunctions.survive_default_htc_config_process(so, ct0conf, len); + return cfunctions.Survive_default_htc_config_process(so, ct0conf, len); } virtual protected void ButtonEvent(SurviveObjectPtr so, byte eventType, byte buttonId, byte axis1Id, ushort axis1Val, byte axis2Id, ushort axis2Val) { - cfunctions.survive_default_button_process(so, eventType, buttonId, axis1Id, axis1Val, axis2Id, axis2Val); + cfunctions.Survive_default_button_process(so, eventType, buttonId, axis1Id, axis1Val, axis2Id, axis2Val); } virtual protected void AngleEvent(SurviveObjectPtr so, int sensor_id, int acode, uint timecode, double length, double angle, uint lh) { - cfunctions.survive_default_angle_process(so, sensor_id, acode, timecode, length, angle, lh); + cfunctions.Survive_default_angle_process(so, sensor_id, acode, timecode, length, angle, lh); } protected void LightHouseEvent(SurviveObjectPtr ctx, byte lighthouse, SurvivePose lighthouse_pose, SurvivePose object_pose) { - cfunctions.survive_default_lighthouse_pose_process(ctx, lighthouse, lighthouse_pose, object_pose); + cfunctions.Survive_default_lighthouse_pose_process(ctx, lighthouse, lighthouse_pose, object_pose); } virtual protected void LightEvent(SurviveObjectPtr so, int sensor_id, int acode, int timeinsweep, UInt32 timecode, UInt32 length, UInt32 lighthouse) { - cfunctions.survive_default_light_process(so, sensor_id, acode, timeinsweep, timecode, length, lighthouse); + cfunctions.Survive_default_light_process(so, sensor_id, acode, timeinsweep, timecode, length, lighthouse); + + //Console.WriteLine("LightEvent"); } - virtual protected void PoseEvent(IntPtr so, byte lighthouse, SurvivePose pose) + virtual protected void PoseEvent(SurviveObjectPtr so, byte lighthouse, SurvivePose pose) { - cfunctions.survive_default_raw_pose_process(so, lighthouse, pose); + cfunctions.Survive_default_raw_pose_process(so, lighthouse, pose); + + Console.WriteLine("PoseEvent"); } public int Poll() { - return cfunctions.survive_poll(ctx); + return cfunctions.Survive_poll(ctx); } } + + public struct Vector3 + { + public float x; + public float y; + public float z; + } + + public struct Qutarnion + { + public float x; + public float y; + public float z; + public float w; + } }
\ No newline at end of file |