void JointHandler_DataIn(string data) { var Datas = _jointHandler.ResolveCoordinates(data); if (Datas == null || Datas.Length == 0)//no data in { return; } StringBuilder sb = new StringBuilder(); foreach (var valueName in Datas) { try { var value = valueName; sb.Append(value.ToString() + ","); } catch (Exception e) { Console.WriteLine(e.Message); return; } } var dataValue = sb.ToString().TrimEnd(','); CalFlash(dataValue); }
public void TestCoord() { ArmHandler jh = new ArmHandler(12345); string testString = "roll:-74.60|pitch:8.41|yaw:-169|roll2:-33.45|pitch2:36.33|yaw2:104"; double[] datas = jh.ResolveCoordinates(testString); Assert.AreEqual(-74.60, datas[0]); Assert.AreEqual(8.41, datas[1]); Assert.AreEqual(-11, datas[2]); Assert.AreEqual(-33.45, datas[3]); Assert.AreEqual(36.33, datas[4]); Assert.AreEqual(76, datas[5]); }
public void TestCoord() { ArmHandler jh = new ArmHandler(12345); string testString = "roll:-74.60|pitch:8.41|yaw:-169|roll2:-33.45|pitch2:36.33|yaw2:104"; double[] datas = jh.ResolveCoordinates(testString); Assert.AreEqual(-74.60, datas[0]); Assert.AreEqual(8.41, datas[1]); Assert.AreEqual(-11, datas[2]); Assert.AreEqual(-33.45, datas[3]); Assert.AreEqual(36.33, datas[4]); Assert.AreEqual(76, datas[5]); }