public void testFilterAngles()
{
Angles angles = new Angles();
angles.currAngles = new List<float> { Angles.inRadian(90), Angles.inRadian(90), Angles.inRadian(90), Angles.inRadian(90), Angles.inRadian(90) };
float[] newAngles = { Angles.inRadian(105), Angles.inRadian(105), Angles.inRadian(95), Angles.inRadian(105), Angles.inRadian(105) };
float[] filteredAngles = angles.checkDifference(newAngles);
for (int i = 0; i < filteredAngles.Length; i++)
{
Assert.AreEqual(angles.currAngles[i], filteredAngles[i]);
}
}
public LArm(Aldebaran.Proxies.MotionProxy mp)
{
this.mp = mp;
angles = new Angles(mp, joints);
}
public LArm(Aldebaran.Proxies.MotionProxy mp)
{
this.mp = mp;
angles = new Angles(mp, joints);
}
