Add creation for kinematic node

Static persisted also outputs on the frame created elements

Nodes/VVVV.DX11.Nodes.Bullet/Nodes/Bodies/Rigid/BulletCreatePersistedKinematicBodyNode.cs

@@ -0,0 +1,121 @@
+using System;
+using System.Collections.Generic;
+using System.Linq;
+using System.Text;
+
+using VVVV.PluginInterfaces.V2;
+
+using BulletSharp;
+using VVVV.DataTypes.Bullet;
+using VVVV.Internals.Bullet;
+using VVVV.Bullet.Core;
+
+namespace VVVV.Nodes.Bullet
+{
+    [PluginInfo(Name = "CreateKinematicBody", Category = "Bullet", Version = "Rigid.Persist", Author = "vux", Help = "Creates a rigid kinematic body, and preserves those in the output", AutoEvaluate = true)]
+    public class BulletCreateKinematicRigidBodyPeristedNode : IPluginEvaluate
+    {
+        [Input("World", IsSingle = true)]
+        protected Pin<IRigidBodyContainer> worldInput;
+
+        [Input("Shapes")]
+        protected Pin<DynamicShapeDefinitionBase> shapesInput;
+
+        [Input("Initial Pose")]
+        protected Pin<RigidBodyPose> initialPoseInput;
+
+        [Input("Initial Motion Properties")]
+        protected Pin<RigidBodyMotionProperties> initialMotionProperties;
+
+        [Input("Initial Properties")]
+        protected Pin<RigidBodyProperties> initialProperties;
+
+        [Input("Do Create", IsBang = true)]
+        protected ISpread<bool> doCreate;
+
+        [Output("Bodies")]
+        protected ISpread<RigidBody> bodiesOutput;
+
+        [Output("Id")]
+        protected ISpread<int> idOutput;
+
+        [Output("Created Bodies")]
+        protected ISpread<RigidBody> createdBodiesOutput;
+
+
+        private RigidBodyListListener persistedList = new RigidBodyListListener();
+        private List<RigidBody> frameBodyOutput = new List<RigidBody>();
+
+        public void Evaluate(int SpreadMax)
+        {
+            this.frameBodyOutput.Clear();
+
+            IRigidBodyContainer inputWorld = this.worldInput[0];
+            if (inputWorld != null)
+            {
+                this.persistedList.UpdateWorld(inputWorld);
+
+                if (this.shapesInput.IsConnected)
+                {
+                    for (int i = 0; i < SpreadMax; i++)
+                    {
+                        if (doCreate[i])
+                        {
+                            RigidBodyPose pose = this.initialPoseInput.IsConnected ? this.initialPoseInput[i] : RigidBodyPose.Default;
+                            RigidBodyProperties properties = this.initialProperties.IsConnected ? this.initialProperties[i] : RigidBodyProperties.Default;
+                            RigidBodyMotionProperties motionProperties = this.initialMotionProperties.IsConnected ? this.initialMotionProperties[i] : new RigidBodyMotionProperties();
+
+                            ShapeCustomData shapeData = new ShapeCustomData();
+                            DynamicShapeDefinitionBase shape = this.shapesInput[i];
+                            shapeData.ShapeDef = shape;
+
+                            CollisionShape collisionShape = shapeData.ShapeDef.GetShape(shapeData);
+
+                            //Build mass for dynamic object
+                            Vector3 localinertia = Vector3.Zero;
+                            if (shape.Mass > 0.0f)
+                            {
+                                collisionShape.CalculateLocalInertia(shape.Mass, out localinertia);
+                            }
+
+                            Tuple<RigidBody, int> createBodyResult = inputWorld.CreateRigidBody(collisionShape, ref pose, ref properties, ref localinertia, shape.Mass);
+                            createBodyResult.Item1.CollisionFlags |= CollisionFlags.KinematicObject;
+
+                            createBodyResult.Item1.ApplyMotionProperties(ref motionProperties);
+
+                            this.persistedList.Append(createBodyResult.Item1, createBodyResult.Item2);
+                            frameBodyOutput.Add(createBodyResult.Item1);
+                        }
+                    }
+                }
+
+                this.bodiesOutput.SliceCount = this.persistedList.Bodies.Count;
+                this.idOutput.SliceCount = this.persistedList.Ids.Count;
+
+                List<RigidBody> bodies = this.persistedList.Bodies;
+                List<int> ids = this.persistedList.Ids;
+
+                for (int i = 0; i < bodies.Count; i++)
+                {
+                    this.bodiesOutput[i] = bodies[i];
+                    this.idOutput[i] = ids[i];
+                }
+
+                this.createdBodiesOutput.SliceCount = this.frameBodyOutput.Count;
+                for (int i = 0; i < frameBodyOutput.Count; i++)
+                {
+                    this.createdBodiesOutput[i] = frameBodyOutput[i];
+                }
+
+            }
+            else
+            {
+                this.bodiesOutput.SliceCount = 0;
+                this.idOutput.SliceCount = 0;
+                this.createdBodiesOutput.SliceCount = 0;
+            }
+        }
+
+    }
+}
+

Nodes/VVVV.DX11.Nodes.Bullet/Nodes/Bodies/Rigid/BulletCreatePersistedStaticBodyNode.cs

@@ -39,10 +39,15 @@ public class BulletCreatePeristedStaticRigidBodyNode : IPluginEvaluate
         [Output("Id")]
         protected ISpread<int> idOutput;
 
+        [Output("Created Bodies")]
+        protected ISpread<RigidBody> createdBodiesOutput;
+
         private RigidBodyListListener persistedList = new RigidBodyListListener();
+        private List<RigidBody> frameBodyOutput = new List<RigidBody>();
 
         public void Evaluate(int SpreadMax)
         {
+            this.frameBodyOutput.Clear();
             IRigidBodyContainer world = this.worldInput[0];
 
             if (world != null)
@@ -68,6 +73,7 @@ public void Evaluate(int SpreadMax)
                             bodyCreateResult.Item1.CollisionFlags = CollisionFlags.StaticObject;
 
                             this.persistedList.Append(bodyCreateResult.Item1, bodyCreateResult.Item2);
+                            frameBodyOutput.Add(bodyCreateResult.Item1);
                         }
                     }
                 }
@@ -83,11 +89,18 @@ public void Evaluate(int SpreadMax)
                     this.bodiesOutput[i] = bodies[i];
                     this.idOutput[i] = ids[i];
                 }
+
+                this.createdBodiesOutput.SliceCount = this.frameBodyOutput.Count;
+                for (int i = 0; i < frameBodyOutput.Count; i++)
+                {
+                    this.createdBodiesOutput[i] = frameBodyOutput[i];
+                }
             }
             else
             {
                 this.bodiesOutput.SliceCount = 0;
                 this.idOutput.SliceCount = 0;
+                this.createdBodiesOutput.SliceCount = 0;
             }
         }
     }

Nodes/VVVV.DX11.Nodes.Bullet/VVVV.Nodes.Bullet.csproj

@@ -110,6 +110,7 @@
     <Compile Include="Nodes\Bodies\Interactions\Rigid\BulletApplyImpulseNode.cs" />
     <Compile Include="Nodes\Bodies\Interactions\Rigid\BulletApplyTorqueNode.cs" />
     <Compile Include="Nodes\Bodies\Rigid\BulletCreateDynamicBodyNode.cs" />
+    <Compile Include="Nodes\Bodies\Rigid\BulletCreatePersistedKinematicBodyNode.cs" />
     <Compile Include="Nodes\Bodies\Rigid\BulletCreatePersistedDynamicBodyNode.cs" />
     <Compile Include="Nodes\Bodies\Rigid\BulletCreatePersistedStaticBodyNode.cs" />
     <Compile Include="Nodes\Bodies\Rigid\BulletCreateStaticBodyNode.cs" />