public RobotKeypoint(int id)
{
color = Color.Black;
this.id = id;
name = "Robot " + id;
runningPath = new PathToRobotRenderer();
commandedPath = new PathToRobotRenderer();
pose = new RobotPose();
origPlygn = new Polygon();
origPlygn.Add(new Vector2(.25, .36));
origPlygn.Add(new Vector2(.25, -.36));
origPlygn.Add(new Vector2(-.25, -.36));
origPlygn.Add(new Vector2(-.25, .36));
bodyPlygn = new Polygon(origPlygn.points);
}
PathToRobotRenderer runningPath; // the path that the robot is currently running
#endregion Fields
#region Constructors
public RobotKeypoint(int id)
{
color = Color.Black;
this.id = id;
name = "Robot " + id;
runningPath = new PathToRobotRenderer();
commandedPath = new PathToRobotRenderer();
pose = new RobotPose();
origPlygn = new Polygon();
origPlygn.Add(new Vector2(.25, .36));
origPlygn.Add(new Vector2(.25, -.36));
origPlygn.Add(new Vector2(-.25, -.36));
origPlygn.Add(new Vector2(-.25, .36));
bodyPlygn = new Polygon(origPlygn.points);
}
