//放卡到离心逻辑
public bool CenPutLogic(CentrifugeMDevice cendev)
{
if (resmanager.handseat_resinfo != null ||
actionmanager.getAllActionsCount(piercerDevice) != 0 ||
actionmanager.getAllActionsCount(handDevice) != 0 ||
actionmanager.getAllActionsCount(cendev) != 0)
{
return(false);
}
bool isallcen = true;//是否在离心机内的所有卡当前动作是离心
foreach (var seat in resmanager.centrifuge_list)
{
if (seat.Code == cendev.Centrifugem.Code.SetValue)
{
for (int i = 0; i < seat.Values.Length; i++)
{
ResInfoData resinfo = (ResInfoData)seat.Values[i, 0];
if (resinfo != null && resinfo.InjectFinish && resinfo.PutOk)
{
isallcen = resinfo.GetActionAt(0) == ActionPoint.ActionPointType.Centrifugal;
if (isallcen == false)
{
break;
}
}
}
break;
}
}
//普通卡位
List <ResInfoData> resinfo_list = new List <ResInfoData>();
foreach (var seat in resmanager.gelseat_list)
{
for (int i = 0; i < seat.Values.Length; i++)
{
ResInfoData resinfo = (ResInfoData)seat.Values[i, 0];
if (resinfo != null && resinfo.InjectFinish && resinfo.PutOk)
{
if (resinfo.GetActionAt(0) == ActionPoint.ActionPointType.Centrifugal)
{
resinfo_list.Add(resinfo);
}
}
}
}
//把卡转到离心位
if (resinfo_list.Count != 0)
{
var seque = Sequence.create();
bool is_put = false;
seque.AddAction(InitXyz.create(cendev, 30000, false, false, true));
foreach (var resinfo in resinfo_list)
{
var put_seat = resmanager.GetResByCode("null", "T_BJ_Centrifuge", cendev.Centrifugem.Code.SetValue);
if (isallcen == false)
{
put_seat = null;
}
if (put_seat == null && resinfo.Purpose != "3")
{
put_seat = resmanager.GetResByCode("null", "T_BJ_GelSeat", "", "3");
}
if (put_seat != null)
{
var put_gel = generater.GenerateTakeGelFromNormal(resinfo, ref seque);
if (put_seat.Purpose == "lxj")
{
generater.GeneratePutGelToCent(cendev.Centrifugem.Code.SetValue, put_seat, put_gel, ref seque);
}
else
{
generater.GeneratePutGelToNormal(put_seat, put_gel, ref seque);
}
is_put = true;
}
}
if (is_put)
{
seque.runAction(handDevice);
return(true);
}
}
return(false);
}
//离心开始逻辑
public bool CenRunLogic(CentrifugeMDevice cendev)
{
bool is_allcenact = true; //是否全是离心动作
bool is_allputok = true; //是否全是已放好
bool is_empty = true; //是否为空
bool is_gelfull = false; //是否已满
bool is_gelsoon = false; //是否有卡快要离心
int gel_count = 0;
List <ResInfoData> resinfo_list = new List <ResInfoData>();
if (experiment_package_list.Count == 0)
{
return(false);
}
foreach (var seat in resmanager.centrifuge_list)
{
if (seat.Code == cendev.Centrifugem.Code.SetValue)
{
for (int i = 0; i < seat.Values.Length; i++)
{
ResInfoData resinfo = (ResInfoData)seat.Values[i, 0];
if (resinfo != null && resinfo.PutOk)
{
is_empty = false;
var exp_pack = GetExpPackageByMask(resinfo.GetGelMask());
if (exp_pack == null)
{
exp_pack = GetExpPackageByMask(resinfo.GetCodeAt(0));
}
System.Diagnostics.Debug.Assert(exp_pack != null);
if (exp_pack == null)
{
return(false);
}
is_allcenact = is_allcenact && exp_pack.GetActionTypeAt(0) == TestStepEnum.ZKDLXJ;
is_allputok = is_allputok && resinfo.PutOk;
resinfo_list.Add(resinfo);
gel_count++;
}
}
is_gelfull = gel_count >= seat.Values.Length;
}
}
if ((is_gelfull == false && actionmanager.getAllActionsCount(handDevice) != 0) || actionmanager.getAllActionsCount(cendev) != 0)
{
return(false);
}
//普通卡位是否有卡快要离心
foreach (var seat in resmanager.gelseat_list)
{
for (int i = 0; i < seat.Values.Length; i++)
{
ResInfoData resinfo = (ResInfoData)seat.Values[i, 0];
if (resinfo != null && resinfo.PutOk && resinfo.FindCode("pei*", false) == false)
{
var exp_pack = GetExpPackageByMask(resinfo.GetGelMask());
if (exp_pack == null)
{
continue;
}
is_gelsoon = (exp_pack.GetActionTypeAt(0) == TestStepEnum.ZKDLXJ) ||
(exp_pack.GetActionTypeAt(0) == TestStepEnum.ZKDFY &&
exp_pack.GetActionTypeAt(1) == TestStepEnum.ZKDLXJ &&
exp_pack.hatch_time - exp_pack.hatch_cur_time <= 20000);
if (seat.Purpose == 4 && exp_pack.FindAct(TestStepEnum.ZKDLXJ) && exp_pack.FindAct(TestStepEnum.ZKDFY) == false)
{
is_gelsoon = true;
}
if (is_gelsoon)
{
break;
}
}
}
if (is_gelsoon)
{
break;
}
}
//检测是否满足运行条件
if (is_allcenact && is_allputok && !is_empty && (!is_gelsoon || is_gelfull))
{
int hspeed = (int)cendev.Centrifugem.HightSpeed.SetValue;
int lspeed = (int)cendev.Centrifugem.LowSpeed.SetValue;
int htime = (int)cendev.Centrifugem.HightSpeedTime.SetValue;
int ltime = (int)cendev.Centrifugem.LowSpeedTime.SetValue;
int uphtime = (int)cendev.Centrifugem.AddHSpeedTime.SetValue;
int upltime = (int)cendev.Centrifugem.AddLSpeedTime.SetValue;
int stime = (int)cendev.Centrifugem.StopSpeedTime.SetValue;
//配平卡动作(如果离心机内卡是单数就再放一张配平卡)
var seque_pei = Sequence.create();
var seque = Sequence.create();
if (resinfo_list.Count() % 2 != 0)
{
var spaw = Spawn.create();
var put_seque = Sequence.create();
//得到配平卡
var pei_gel = resmanager.GetResByCode("pei" + cendev.Centrifugem.Code.SetValue, "T_BJ_GelSeat");
var put_gel = generater.GenerateTakeGelFromNormal(pei_gel, ref put_seque);
T_GelStep[] pei_step = { new T_GelStep(), new T_GelStep() };
pei_step[0].StepClass = TestStepEnum.ZKDLXJ;
pei_step[1].StepClass = TestStepEnum.PutPeiGelBack;
var exp_pack = ExperimentPackage.Create(pei_step.ToList(), pei_gel.GetCodeAt(0), "123", 8, 0, 1, 0, false, 0, 0, false);
exp_pack.is_jyjs = true;
experiment_package_list.Add(exp_pack);
resinfo_list.Add(put_gel);
var put_seat = resmanager.GetResByCode("null", "T_BJ_Centrifuge", cendev.Centrifugem.Code.SetValue);
spaw.AddAction(put_seque);
spaw.AddAction(MoveTo.create(cendev, 30001, -1, -1, put_seat.CenGelP[put_seat.CountX]));
seque_pei.AddAction(spaw);
generater.GeneratePutGelToCent(cendev.Centrifugem.Code.SetValue, put_seat, put_gel, ref seque_pei);
}
seque_pei.AddAction(HandOpenCloseDoor.create(handDevice, 5000, cendev.Centrifugem.Code.SetValue, false));
seque.AddAction(SkWaitForAction.create(handDevice, seque_pei));
seque.AddAction(CentrifugeStart.create(cendev, 6000000, hspeed, lspeed, htime, ltime, uphtime, upltime, stime));
seque.AddAction(SkCallBackFun.create((ActionBase acttem) =>
{
foreach (var resinfo in resinfo_list)
{
var exp_pack = GetExpPackageByMask(resinfo.GetGelMask());
if (exp_pack == null)
{
exp_pack = GetExpPackageByMask(resinfo.GetCodeAt(0));
}
System.Diagnostics.Debug.Assert(exp_pack != null);
var act = exp_pack.GetActionAt(0);
act.State = 2;
}
return(true);
}));
seque_pei.runAction(handDevice);
seque.runAction(cendev);
return(true);
}
return(false);
}
//离心开始逻辑
public bool CenRunLogic(CentrifugeMDevice cendev)
{
bool is_allcenact = true; //是否全是离心动作
bool is_allputok = true; //是否全是已放好
bool is_empty = true; //是否为空
bool is_gelfull = false; //是否已满
bool is_gelsoon = false; //是否有卡快要离心
int gel_count = 0;
List <ResInfoData> resinfo_list = new List <ResInfoData>();
foreach (var seat in resmanager.centrifuge_list)
{
if (seat.Code == cendev.Centrifugem.Code.SetValue)
{
for (int i = 0; i < seat.Values.Length; i++)
{
ResInfoData resinfo = (ResInfoData)seat.Values[i, 0];
if (resinfo != null && resinfo.InjectFinish && resinfo.PutOk)
{
is_empty = false;
is_allcenact = is_allcenact && resinfo.GetActionAt(0) == ActionPoint.ActionPointType.Centrifugal;
is_allputok = is_allputok && resinfo.PutOk;
resinfo_list.Add(resinfo);
gel_count++;
}
}
is_gelfull = gel_count >= seat.Values.Length;
}
}
if ((is_gelfull == false && actionmanager.getAllActionsCount(handDevice) != 0) || actionmanager.getAllActionsCount(cendev) != 0)
{
return(false);
}
//普通卡位是否有卡快要离心
foreach (var seat in resmanager.gelseat_list)
{
for (int i = 0; i < seat.Values.Length; i++)
{
ResInfoData resinfo = (ResInfoData)seat.Values[i, 0];
if (resinfo != null && resinfo.InjectFinish && resinfo.PutOk)
{
is_gelsoon = (resinfo.GetActionAt(0) == ActionPoint.ActionPointType.Centrifugal) ||
(resinfo.GetActionAt(0) == ActionPoint.ActionPointType.Hatch &&
resinfo.GetActionAt(1) == ActionPoint.ActionPointType.Centrifugal &&
resinfo.HatchTime - resinfo.HatchCurTime <= 20000);
if (seat.Purpose == 4 && resinfo.FindAct(ActionPoint.ActionPointType.Centrifugal) && resinfo.FindAct(ActionPoint.ActionPointType.Hatch) == false)
{
is_gelsoon = true;
}
if (is_gelsoon)
{
break;
}
}
}
if (is_gelsoon)
{
break;
}
}
//检测是否满足运行条件
if (is_allcenact && is_allputok && !is_empty && (!is_gelsoon || is_gelfull))
{
int hspeed = (int)cendev.Centrifugem.HightSpeed.SetValue;
int lspeed = (int)cendev.Centrifugem.LowSpeed.SetValue;
int htime = (int)cendev.Centrifugem.HightSpeedTime.SetValue;
int ltime = (int)cendev.Centrifugem.LowSpeedTime.SetValue;
int uphtime = (int)cendev.Centrifugem.AddHSpeedTime.SetValue;
int upltime = (int)cendev.Centrifugem.AddLSpeedTime.SetValue;
int stime = (int)cendev.Centrifugem.StopSpeedTime.SetValue;
//配平卡动作(如果离心机内卡是单数就再放一张配平卡)
var seque_pei = Sequence.create();
var seque = Sequence.create();
if (resinfo_list.Count() % 2 != 0)
{
var spaw = Spawn.create();
var put_seque = Sequence.create();
//得到配平卡
var pei_gel = resmanager.GetResByCode("pei" + cendev.Centrifugem.Code.SetValue, "T_BJ_GelSeat");
var put_gel = generater.GenerateTakeGelFromNormal(pei_gel, ref put_seque);
put_gel.ActionList.Add(ActionPointType.Centrifugal);
put_gel.ActionList.Add(ActionPointType.PutPeiGelBack);
put_gel.InjectFinish = true;
resinfo_list.Add(put_gel);
var put_seat = resmanager.GetResByCode("null", "T_BJ_Centrifuge", cendev.Centrifugem.Code.SetValue);
spaw.AddAction(put_seque);
spaw.AddAction(MoveTo.create(cendev, 30001, -1, -1, put_seat.CenGelP[put_seat.CountX]));
seque_pei.AddAction(spaw);
generater.GeneratePutGelToCent(cendev.Centrifugem.Code.SetValue, put_seat, put_gel, ref seque_pei);
}
seque_pei.AddAction(HandOpenCloseDoor.create(handDevice, 5000, cendev.Centrifugem.Code.SetValue, false));
seque.AddAction(SkWaitForAction.create(handDevice, seque_pei));
seque.AddAction(CentrifugeStart.create(cendev, 300000, hspeed, lspeed, htime, ltime, uphtime, upltime, stime));
seque.AddAction(SkCallBackFun.create((ActionBase acttem) =>
{
foreach (var resinfo in resinfo_list)
{
if (resinfo.InjectFinish)
{
resinfo.RemoveActionAt(0);
}
}
return(true);
}));
seque_pei.runAction(handDevice);
seque.runAction(cendev);
return(true);
}
return(false);
}
