if verbose: print("===> Block Vector 0:6:2x1 tanspose") M = Mref[0:6:2, 1:2].T assert (np.array_equal(M.squeeze(), eigenpy.reflex(M, verbose))) if verbose: print("===> From Py to Eigen::VectorXd") if verbose: print("===> From Py to Eigen::VectorXd") if verbose: print("===> From Py to Eigen::VectorXd") if verbose: print("===> Block Vector 0:6:2x1 1 dim") M = Mref[0:6:2, 1].T # TODO # assert( np.array_equal(M.T,eigenpy.reflexV(M,verbose)) ); if verbose: print("===> Block Vector 0:6:2x1") M = Mref[0:6:2, 1:2] assert (np.array_equal(M.squeeze(), eigenpy.reflexV(M, verbose))) if verbose: print("===> Block Vector 0:6:2x1 transpose") M = Mref[0:6:2, 1:2].T # TODO # assert( np.array_equal(M.T,eigenpy.reflexV(M,verbose)) ); if verbose: print("===> From Py to Eigen::Matrix3d") if verbose: print("===> From Py to Eigen::Matrix3d") if verbose: print("===> From Py to Eigen::Matrix3d") if verbose: print("===> Block Vector 0:3x0:6:2 ") M = Mref[0:3, 0:6:2] assert (np.array_equal(M, eigenpy.reflex33(M, verbose))) if verbose: print("===> Block Vector 0:3x0:6:2 T")
if verbose: print "===> Block Vector 0:6:2x1" M = Mref[0:6:2, 1:2] assert (np.array_equal(M, eigenpy.reflex(M, verbose))) if verbose: print "===> Block Vector 0:6:2x1 tanspose" M = Mref[0:6:2, 1:2].T assert (np.array_equal(M, eigenpy.reflex(M, verbose))) if verbose: print "===> From Py to Eigen::VectorXd" if verbose: print "===> From Py to Eigen::VectorXd" if verbose: print "===> From Py to Eigen::VectorXd" if verbose: print "===> Block Vector 0:6:2x1 1 dim" M = Mref[0:6:2, 1].T assert (np.array_equal(M.T, eigenpy.reflexV(M, verbose))) if verbose: print "===> Block Vector 0:6:2x1" M = Mref[0:6:2, 1:2] assert (np.array_equal(M, eigenpy.reflexV(M, verbose))) if verbose: print "===> Block Vector 0:6:2x1 transpose" M = Mref[0:6:2, 1:2].T assert (np.array_equal(M.T, eigenpy.reflexV(M, verbose))) if verbose: print "===> From Py to Eigen::Matrix3d" if verbose: print "===> From Py to Eigen::Matrix3d" if verbose: print "===> From Py to Eigen::Matrix3d" if verbose: print "===> Block Vector 0:3x0:6:2 " M = Mref[0:3, 0:6:2]
if verbose: print "===> Block Vector 0:6:2x1" M = Mref[0:6:2,1:2] assert( np.array_equal(M,eigenpy.reflex(M,verbose)) ); if verbose: print "===> Block Vector 0:6:2x1 tanspose" M = Mref[0:6:2,1:2].T assert( np.array_equal(M,eigenpy.reflex(M,verbose)) ); if verbose: print "===> From Py to Eigen::VectorXd" if verbose: print "===> From Py to Eigen::VectorXd" if verbose: print "===> From Py to Eigen::VectorXd" if verbose: print "===> Block Vector 0:6:2x1 1 dim" M = Mref[0:6:2,1].T assert( np.array_equal(M.T,eigenpy.reflexV(M,verbose)) ); if verbose: print "===> Block Vector 0:6:2x1" M = Mref[0:6:2,1:2] assert( np.array_equal(M,eigenpy.reflexV(M,verbose)) ); if verbose: print "===> Block Vector 0:6:2x1 transpose" M = Mref[0:6:2,1:2].T assert( np.array_equal(M.T,eigenpy.reflexV(M,verbose)) ); if verbose: print "===> From Py to Eigen::Matrix3d" if verbose: print "===> From Py to Eigen::Matrix3d" if verbose: print "===> From Py to Eigen::Matrix3d" if verbose: print "===> Block Vector 0:3x0:6:2 " M = Mref[0:3,0:6:2]