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]);
}
