public void add(subactInfo subact)
{
for (int i = 0; i < subact.Count(); i++)
{
txt.WriteLine(subact.infotxt[i]);
}
}
public static subactInfo Pick(Objects cup)
{
subactInfo rtn = new subactInfo();
URCoordinates up = new URCoordinates(cup.gripPos());
URCoordinates debug = new URCoordinates(up);
URCoordinates down = new URCoordinates(up);
debug.Y -= 0.02f;//上升
rtn.infotxt.Add("position");
rtn.infotxt.Add(debug.ToPos());
rtn.infotxt.Add(up.ToPos());
rtn.infotxt.Add("gripper");
rtn.infotxt.Add("0");
rtn.infotxt.Add("sleep");
rtn.infotxt.Add("1000");
down.Y += 0.07f;//下降
rtn.infotxt.Add("position");
rtn.infotxt.Add(down.ToPos());
rtn.infotxt.Add("gripper");
rtn.infotxt.Add("35");
rtn.infotxt.Add("sleep");
rtn.infotxt.Add("1000");
up.Y -= 0.02f;//上升
rtn.infotxt.Add("position");
rtn.infotxt.Add(up.ToPos());
return(rtn);
}
public static subactInfo Stir(Objects toCup)
{
subactInfo rtn = new subactInfo();
URCoordinates up = new URCoordinates(toCup.gripPos());
up.X -= 0.015f;
up.Z += 0.015f;
up.Y -= 0.06f;//上升
URCoordinates now = new URCoordinates(up);
rtn.infotxt.Add("pmovej");
rtn.infotxt.Add(up.ToPos());
now.Y += 0.05f;//下去
now.X -= 0.01f;
rtn.infotxt.Add(now.ToPos());
now.X += 0.01f;
now.Z += 0.01f;
rtn.infotxt.Add(now.ToPos());
now.X += 0.01f;
now.Z -= 0.01f;
rtn.infotxt.Add(now.ToPos());
now.X -= 0.01f;
now.Z -= 0.01f;
rtn.infotxt.Add(now.ToPos());
now.X -= 0.01f;
now.Z += 0.01f;
rtn.infotxt.Add(now.ToPos());
rtn.infotxt.Add(up.ToPos());
return(rtn);
}
public static subactInfo AddaSpoon(Objects toCup)
{
subactInfo rtn = new subactInfo();
URCoordinates up = new URCoordinates(toCup.gripPos());
up.Rx = 2.2f;
up.Ry = -2.2f;
up.Rz = 0;
up.X -= 0.09f;
up.Z += 0.02f;
up.Y += 0.03f;//下降
URCoordinates upper = new URCoordinates(up);
upper.Y -= 0.07f;//上
rtn.infotxt.Add("pmovej");
rtn.infotxt.Add(upper.ToPos());
URCoordinates add = new URCoordinates(up);
add.Rx = 3.14f;
add.Ry = 0f;
add.Rz = 0f;
add.Y -= 0.09f;//上升
add.X += 0.05f;
rtn.infotxt.Add("pmovej");
rtn.infotxt.Add(up.ToPos());
rtn.infotxt.Add("pmovej");
rtn.infotxt.Add(add.ToPos());
rtn.infotxt.Add("pmovej");
add.Y -= 0.03f;//上升
rtn.infotxt.Add(add.ToPos());
return(rtn);
}
public static subactInfo Scoop()
{
subactInfo rtn = new subactInfo();
rtn.AddFile("Path//Scoop.path");
return(rtn);
}
public static subactInfo Trigger()
{
subactInfo rtn = new subactInfo();
rtn.AddFile("Path//trigger.path");
return(rtn);
}
public static subactInfo Place(Objects cup, URCoordinates Wpoint)
{
cup.setNowPos(Wpoint);
subactInfo rtn = new subactInfo();
URCoordinates up = new URCoordinates(cup.gripPos());
URCoordinates debug = new URCoordinates(up);
URCoordinates down = new URCoordinates(up);
down.Y += 0.07f; //下降
debug.Y -= 0.02f; //上升
rtn.infotxt.Add("position");
rtn.infotxt.Add(debug.ToPos());
rtn.infotxt.Add(up.ToPos());
rtn.infotxt.Add(down.ToPos());
rtn.infotxt.Add("gripper");
rtn.infotxt.Add("0");
rtn.infotxt.Add("sleep");
rtn.infotxt.Add("1000");
rtn.infotxt.Add("position");
rtn.infotxt.Add(up.ToPos());
return(rtn);
}
public static subactInfo Place(subactInfo.place ThePlace)
{
subactInfo rtn = new subactInfo();
if (ThePlace == subactInfo.place.DripTray)
{
string[] file = System.IO.File.ReadAllLines($"Path//toDripTray.path");
foreach (string line in file)
{
rtn.infotxt.Add(line);
}
}
rtn.infotxt.Add("gripper");
rtn.infotxt.Add("0");
rtn.infotxt.Add("sleep");
rtn.infotxt.Add("1000");
return(rtn);
}
public static subactInfo Pour(Objects toCup)
{
subactInfo rtn = new subactInfo();
URCoordinates up = new URCoordinates(toCup.gripPos());
up.Y -= 0.03f;//上升
URCoordinates debug = new URCoordinates(up);
debug.Y -= 0.01f;//上升
URCoordinates now = new URCoordinates(up);
rtn.infotxt.Add("position");
rtn.infotxt.Add(debug.ToPos());
rtn.infotxt.Add(up.ToPos());
now.X -= 0.09f;
rtn.infotxt.Add(now.ToPos());
now.Rx -= 1.0f;
now.Ry += 1.0f;
rtn.infotxt.Add(now.ToPos());
now.X += 0.04f;
rtn.infotxt.Add(now.ToPos());
now.Rx -= 0.57f;
now.Ry += 0.57f;
rtn.infotxt.Add(now.ToPos());
now.X += 0.02f;
rtn.infotxt.Add(now.ToPos());
now.Rx -= 1.13f;
now.Ry += 1.13f;
rtn.infotxt.Add(now.ToPos());
up.Y -= 0.02f;//上升
rtn.infotxt.Add(up.ToPos());
rtn.infotxt.Add(debug.ToPos());
return(rtn);
}
