From c7c01e6b325bf2c9a20c96da3925b861309af737 Mon Sep 17 00:00:00 2001
From: Erwin Coumans <erwincoumans@google.com>
Date: Mon, 20 Jun 2016 14:09:37 -0700
Subject: [PATCH] add one more test, related to b3CreatePoseCommandInit

---
 test/SharedMemory/test.c | 22 +++++++++++++++++++++-
 1 file changed, 21 insertions(+), 1 deletion(-)

diff --git a/test/SharedMemory/test.c b/test/SharedMemory/test.c
index 9d80eed63..a74cb34a6 100644
--- a/test/SharedMemory/test.c
+++ b/test/SharedMemory/test.c
@@ -68,6 +68,9 @@ void testSharedMemory(b3PhysicsClientHandle sm)
             int bodyUniqueId = bodyIndicesOut[0];
             
             numJoints = b3GetNumJoints(sm,bodyUniqueId);
+            ASSERT_EQ(numJoints,7);
+
+#if 0
             b3Printf("numJoints: %d\n", numJoints);
             for (i=0;i<numJoints;i++)
             {
@@ -77,9 +80,26 @@ void testSharedMemory(b3PhysicsClientHandle sm)
                     b3Printf("jointInfo[%d].m_jointName=%s\n",i,jointInfo.m_jointName);
                 }
             }
-            //ASSERT_EQ(numBodies ==1);
+#endif
+            {
+                b3SharedMemoryStatusHandle statusHandle;
+                b3SharedMemoryCommandHandle commandHandle;
+                double jointAngle = 0.f;
+                
+                commandHandle = b3CreatePoseCommandInit(sm, bodyUniqueId);
+                for (int jointIndex=0;jointIndex<numJoints;jointIndex++)
+                {
+                    b3CreatePoseCommandSetJointPosition(sm, commandHandle, jointIndex, jointAngle);
+                }
+                
+                statusHandle = b3SubmitClientCommandAndWaitStatus(sm, commandHandle);
+
+                ASSERT_EQ(b3GetStatusType(statusHandle), CMD_CLIENT_COMMAND_COMPLETED);
+            }
+            
         }
         
+        
         {
             b3SharedMemoryStatusHandle statusHandle;
 			int statusType;