public void UpdateIcon(MAVState mav, float x, float y, float z, bool movable)
{
foreach (var icon in icons)
{
if (icon.interf == mav)
{
icon.Movable = movable;
if (!movable)
{
icon.x = 0;
icon.y = 0;
icon.z = 0;
icon.Color = Color.Blue;
}
else
{
icon.x = x;
icon.y = y;
icon.z = z;
icon.Color = Color.Red;
}
this.Invalidate();
return;
}
}
Console.WriteLine("ADD MAV {0} {1} {2}", x, y, z);
icons.Add(new icon()
{
interf = mav, y = y, z = z, x = x, Movable = movable, Name = mav.ToString()
});
this.Invalidate();
}
public void setOffsets(MAVState mav, double x, double y, double z)
{
offsets[mav] = new HIL.Vector3(x, y, z);
log.Info(mav.ToString() + " " + offsets[mav].ToString());
}
