public void GetDefaultAxis_JointAxis_Succeeds()
 {
     Assert.AreEqual(new Vector3(-1, 0, 0), TestUrdfJoint.DefaultAxis());
 }
 public void GetAxisData_ArbitraryData_Succeeds()
 {
     Assert.AreEqual(new double[] { 1.234568, 2.345679, 3.456789 },
                     TestUrdfJoint.AxisData(new Vector3(1.2345678f, 2.3456789f, 3.4567891f)).xyz);
 }
        public void GetAxis_JointAxis_Succeeds()
        {
            var axis = new Joint.Axis(new double[] { 1, 2, 3 });

            Assert.AreEqual(new Vector3(-2, 3, 1), TestUrdfJoint.Axis(axis));
        }