public void TestGetTransformBetweenVectorsAroundPointAllDirs()
{
var comp = new DoubleEqualityComparerWithTolerance();
var mathServ = new SwVectorMathService(Sw.SldWorks.IGetMathUtility());
var transform = mathServ.GetTransformBetweenVectorsAroundPoint(
new Vector(-0.86064621310564815, -0.45399049973946992, -0.230609457770521),
new Vector(0, 1, 0), new Point(0, 0, 0));
//TestDisplayOnBody(transform, "Data\\t2.sldprt", "Body-Move/Copy2");
foreach (var d in transform.Rotation.ToArray())
{
Debug.Print(d.ToString());
}
Assert.IsTrue(transform.Translation.ToArray().SequenceEqual(new double[] { 0, 0, 0 }, comp));
Assert.IsTrue(transform.Rotation.ToArray().SequenceEqual(new double[]
{
-0.356591604687574, -0.860646213105648, -0.363497624934811,
0.860646213105648, -0.45399049973947, 0.230609457770521,
-0.363497624934811, -0.230609457770521, 0.902601104948104
}
, comp));
Assert.AreEqual(1, transform.Scale);
}
public void TestGetTransformBetweenVectorsAroundPointYZ90Deg()
{
var comp = new DoubleEqualityComparerWithTolerance();
var mathServ = new SwVectorMathService(Sw.SldWorks.IGetMathUtility());
var transform = mathServ.GetTransformBetweenVectorsAroundPoint(new Vector(0, 0, 1),
new Vector(0, 1, 0), new Point(0, 0, 0));
//TestDisplayOnBody(transform, "Data\\t5.sldprt", "Boss-Extrude2");
Assert.IsTrue(transform.Translation.ToArray().SequenceEqual(new double[] { 0, 0, 0 }, comp));
Assert.IsTrue(transform.Rotation.ToArray().SequenceEqual(new double[] { 1, 0, 0, 0, 0, -1, 0, 1, 0 }, comp));
Assert.AreEqual(1, transform.Scale);
}
public void TestTransformPoint()
{
var comp = new DoubleEqualityComparerWithTolerance();
var mathServ = new SwVectorMathService(Sw.SldWorks.IGetMathUtility());
var transform = new TransformationMaxtrix(
new RotationMatrix(-0.356591604687574, -0.860646213105648, -0.363497624934811,
0.860646213105648, -0.45399049973947, 0.230609457770521,
-0.363497624934811, -0.230609457770521, 0.902601104948104), new Vector(0, 0, 0), 1);
var pts = new Point[6];
pts[0] = new Point(-0.110883845818614, 0.0605238203210351, -0.0239825852813666);
pts[1] = new Point(-0.0412497473005035, 0.179859854385059, 0.0275862063054218);
pts[2] = new Point(-0.142959784835457, 0.106453187928056, 0.00530736214458289);
pts[3] = new Point(-0.0405325336202925, 0.171216718860278, 0.0419248817887173);
pts[4] = new Point(-0.13321429487189, 0.0821558975737544, 0.0167696845654225);
pts[5] = new Point(-0.0104076774276791, 0.149982352301203, -0.0286994667274928);
var ptsTransf = new Point[6];
for (int i = 0; i < pts.Length; i++)
{
ptsTransf[i] = mathServ.TransformPoint(pts[i], transform);
}
//TestDisplayOnBody(transform, "Data\\t2.sldprt", "Body-Move/Copy2", ptsTransf);
Assert.IsTrue(ptsTransf[0].ToArray().SequenceEqual(new double[] { 0.100347458065948, 0.0734851335523633, 0.0326166720106647 }, comp));
Assert.IsTrue(ptsTransf[1].ToArray().SequenceEqual(new double[] { 0.159477495676095, -0.0525148664476371, 0.0813709089599175 }, comp));
Assert.IsTrue(ptsTransf[2].ToArray().SequenceEqual(new double[] { 0.140667578609346, 0.0734851335523624, 0.0813050851309728 }, comp));
Assert.IsTrue(ptsTransf[3].ToArray().SequenceEqual(new double[] { 0.146570986957314, -0.0525148664476372, 0.092059119028498 }, comp));
Assert.IsTrue(ptsTransf[4].ToArray().SequenceEqual(new double[] { 0.112114520796401, 0.073485133552363, 0.082505342603813 }, comp));
Assert.IsTrue(ptsTransf[5].ToArray().SequenceEqual(new double[] { 0.143225221928054, -0.0525148664476371, 0.0124663445857203 }, comp));
}
