|
|
#include "StdAfx.h"
|
|
|
#include "CommonFlowMgr.h"
|
|
|
#include "WorkCmdMovePlatformXY.h"
|
|
|
#include "MsgBox.h"
|
|
|
#include "WorkCmdInvoker.h"
|
|
|
#include "Propertie.h"
|
|
|
#include "PropertieMgr.h"
|
|
|
#include "AuthorityMgr.h"
|
|
|
#include "LogMgr.h"
|
|
|
#include "Camera.h"
|
|
|
#include "Product.h"
|
|
|
#include "WorkCmdCameraCatch.h"
|
|
|
#include "CStringFuc.h"
|
|
|
#include "PlatformXY.h"
|
|
|
#include "Laser.h"
|
|
|
#include "MarkAreaMgr.h"
|
|
|
#include "WorkCmdMarkArea.h"
|
|
|
#include "WorkCmdMoveMotor.h"
|
|
|
#include "ObjComponentMgr.h"
|
|
|
#include "WorkCmdPciPortSwitch.h"
|
|
|
#include "PciPortMgr.h"
|
|
|
#include "MeasureMgr.h"
|
|
|
#include "ExceptionMsg.h"
|
|
|
#include "FileMgr.h"
|
|
|
#include "CameraHawkvis.h"
|
|
|
#include "WorkCmdMotorToOffsetPos.h"
|
|
|
#include "WorkCmdMotorToMachineOrigin.h"
|
|
|
#include "Motor.h"
|
|
|
#include "WorkCmdDeviceParReset.h"
|
|
|
#include "WorkCmdWorkStart.h"
|
|
|
#include "WorkCmdWorkEnd.h"
|
|
|
#include "ProductMgr.h"
|
|
|
#include "DeviceState.h"
|
|
|
#include "WorkFileMgr.h"
|
|
|
#include "CommPortMgr.h"
|
|
|
#include "PlcIOMgr.h"
|
|
|
#include "PciCh365Mgr.h"
|
|
|
#include "WorkCmdResetAllMotorErr.h"
|
|
|
#include "WorkCmdWaitMotorStop.h"
|
|
|
#include "WorkCmdSetMotorSpeed.h"
|
|
|
|
|
|
|
|
|
|
|
|
CCommonFlowMgr *gCommonFlowMgr = new CCommonFlowMgr;
|
|
|
CCommonFlowMgr::CCommonFlowMgr(void)
|
|
|
{
|
|
|
m_bIniPlatfrom = true;//是否初始化电机平台
|
|
|
m_bIniConfirmMsgBox = true;//是否弹出初始化确认对话框
|
|
|
m_bIniMotorX = true;//是否初始化电机X
|
|
|
m_bIniMotorY = true;//是否初始化电机Y
|
|
|
m_bIniMotorZ = false;//是否初始化电机Z
|
|
|
m_bInitedToProductPt = false;//初始化完成后是否返回上料点
|
|
|
|
|
|
m_bFocalAdjust = false;//加工的时候是否实时调整焦距
|
|
|
m_FocalAdjustDis = 0;//变焦距离mm
|
|
|
m_FocalAdjustCnt = 0;//变焦次数(每变焦一次按照下面的参数加工一遍)
|
|
|
m_AreaCycleCnt = 1;//每次一个workarea 的循环加工次数
|
|
|
m_OneObjMarkCnt = 1;//单个元件加工次数
|
|
|
m_SpecialOneObjMarkCnt = 1;//特殊切割次数
|
|
|
m_CutSpeed = 800;//切割速度
|
|
|
m_bBackToProductPt = false;//加工完成后是否返回取料点
|
|
|
m_bSetLightState = false;//是否设置警示灯状态
|
|
|
|
|
|
|
|
|
m_bUseLaser = false;//是否开关激光
|
|
|
|
|
|
m_CalibrationPointGap = 2;//打点之间的间隔mm
|
|
|
m_CalibrationRange = 50;//振镜校准范围mm
|
|
|
|
|
|
m_AlamDelay = 1000;//报警延时(ms)
|
|
|
|
|
|
m_bConnectObj = true;//是否连接多个obj 数据
|
|
|
|
|
|
m_bVacuum = false;//是否使用真空吸附(加工前吸附,结束后放开)
|
|
|
|
|
|
m_ConcentricCnt = 0;//同心数据的数量
|
|
|
m_FirstGap = 0;//第一个拉伸尺寸
|
|
|
m_ConcentricGap = 0.05;//同心数据的间隔mm(大于0 向外)(小于0 向内)
|
|
|
|
|
|
m_RotatoAdjust = 0;//旋转调整mm
|
|
|
m_NoMarkCanWork = true;//没有定位点时也可以加工
|
|
|
m_bCheckObjDataConsistency = true;//是否检查数据的一致性(避免obj 数据不相等的情况)
|
|
|
|
|
|
m_bWorkStop = false;//工作是否停止
|
|
|
|
|
|
m_FindOriginTimes = 5;//自动回原点的加工次数(大于0 时生效)
|
|
|
m_CurWorktimes = 1;//当前的加工次数
|
|
|
|
|
|
m_bStartWorkMsg = true;//加工前提示
|
|
|
m_AllWorkExecTimes = 1;//重复执行次数(用来拷机)
|
|
|
m_CurWorkExecTimes = 0;//当前执行次数(用来拷机)
|
|
|
|
|
|
m_bCollectSpecialObj = false;//是否正在收集特殊对象数据
|
|
|
m_bStretchDataToRealSize = false;//根据抓取结果拉伸数据
|
|
|
}
|
|
|
CCommonFlowMgr::~CCommonFlowMgr(void)
|
|
|
{
|
|
|
}
|
|
|
CMFCPropertyGridProperty * CCommonFlowMgr::CreatGridProperty()
|
|
|
{
|
|
|
CString PropertyName;//属性名称
|
|
|
CString Description;//描述
|
|
|
CString Path = _T("CommonFlowMgr");;//存储路径
|
|
|
CString Name;
|
|
|
//-------------------------------------------------------------------------------//
|
|
|
PropertyName = _T("常用流程");
|
|
|
CMFCPropertyGridProperty* pGroup = new CMFCPropertyGridProperty(PropertyName);
|
|
|
if(gAuthorityMgr->CheckAuthority(_FACTORY))
|
|
|
{
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_bSetLightState");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_bSetLightState);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("状态灯");
|
|
|
Description = _T("是否设置警示灯状态");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_bSetLightState, Description);
|
|
|
pGroup->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_bStartWorkMsg");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_bStartWorkMsg);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("加工前提示");
|
|
|
Description = _T("加工前是否需要对话框确认");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_bStartWorkMsg, Description);
|
|
|
pGroup->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_AllWorkExecTimes");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_AllWorkExecTimes);
|
|
|
pPropertie->SetType(_PROP_TYPE_INT);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("拷机次数");
|
|
|
Description = _T("启动加工时重复执行的次数,用来拷机");
|
|
|
CMFCPropertyGridProperty* p1 = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_AllWorkExecTimes, Description);
|
|
|
pGroup->AddSubItem(p1);
|
|
|
gDevicePropertieMgr.Insert(p1, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_FindOriginTimes");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_FindOriginTimes);
|
|
|
pPropertie->SetType(_PROP_TYPE_INT);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("回原点次数");
|
|
|
Description = _T("每加工多少次回一次原点(大于0 时生效)");
|
|
|
CMFCPropertyGridProperty* p1 = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_FindOriginTimes, Description);
|
|
|
pGroup->AddSubItem(p1);
|
|
|
gDevicePropertieMgr.Insert(p1, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_AlamDelay");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_AlamDelay);
|
|
|
pPropertie->SetType(_PROP_TYPE_INT);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("蜂鸣器延时");
|
|
|
Description = _T("蜂鸣器提示的延时时间(ms)");
|
|
|
CMFCPropertyGridProperty* p1 = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_AlamDelay, Description);
|
|
|
pGroup->AddSubItem(p1);
|
|
|
gDevicePropertieMgr.Insert(p1, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_bCheckObjDataConsistency");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_bCheckObjDataConsistency);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("检查数据一致");
|
|
|
Description = _T("是否检查数据的一致性(避免obj 数据不相等的情况)");
|
|
|
CMFCPropertyGridProperty* p1 = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_bCheckObjDataConsistency, Description);
|
|
|
pGroup->AddSubItem(p1);
|
|
|
gDevicePropertieMgr.Insert(p1, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_NoMarkCanWork");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_NoMarkCanWork);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("无定位加工");
|
|
|
Description = _T("没有定位点时也可以加工");
|
|
|
CMFCPropertyGridProperty* p1 = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_NoMarkCanWork, Description);
|
|
|
pGroup->AddSubItem(p1);
|
|
|
gDevicePropertieMgr.Insert(p1, pPropertie);
|
|
|
}
|
|
|
}
|
|
|
//-------------------------------------------------------------------------------//
|
|
|
{
|
|
|
{
|
|
|
CMFCPropertyGridProperty* pGroup1 = new CMFCPropertyGridProperty(_T("设备初始化"));
|
|
|
if(gAuthorityMgr->CheckAuthority(_FACTORY))
|
|
|
{
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_bIniConfirmMsgBox");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_bIniConfirmMsgBox);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("初始化msgbox");
|
|
|
Description = _T("是否弹出对话框确认");
|
|
|
CMFCPropertyGridProperty* p1 = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_bIniConfirmMsgBox, Description);
|
|
|
pGroup1->AddSubItem(p1);
|
|
|
gDevicePropertieMgr.Insert(p1, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_bIniPlatfrom");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_bIniPlatfrom);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("初始化平台");
|
|
|
Description = _T("是否初始化XY 电机平台");
|
|
|
CMFCPropertyGridProperty* p1 = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_bIniPlatfrom, Description);
|
|
|
pGroup1->AddSubItem(p1);
|
|
|
gDevicePropertieMgr.Insert(p1, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_bIniMotorX");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_bIniMotorX);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("初始化电机X");
|
|
|
Description = _T("是否初始化电机X");
|
|
|
CMFCPropertyGridProperty* p1 = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_bIniMotorX, Description);
|
|
|
pGroup1->AddSubItem(p1);
|
|
|
gDevicePropertieMgr.Insert(p1, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_bIniMotorY");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_bIniMotorY);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("初始化电机Y");
|
|
|
Description = _T("是否初始化电机Y");
|
|
|
CMFCPropertyGridProperty* p1 = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_bIniMotorY, Description);
|
|
|
pGroup1->AddSubItem(p1);
|
|
|
gDevicePropertieMgr.Insert(p1, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_bIniMotorZ");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_bIniMotorZ);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("初始化电机Z");
|
|
|
Description = _T("是否初始化电机Z");
|
|
|
CMFCPropertyGridProperty* p1 = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_bIniMotorZ, Description);
|
|
|
pGroup1->AddSubItem(p1);
|
|
|
gDevicePropertieMgr.Insert(p1, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_bInitedToProductPt");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_bInitedToProductPt);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("回上料点");
|
|
|
Description = _T("初始化完成后是否返回上料点");
|
|
|
CMFCPropertyGridProperty* p1 = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_bInitedToProductPt, Description);
|
|
|
pGroup1->AddSubItem(p1);
|
|
|
gDevicePropertieMgr.Insert(p1, pPropertie);
|
|
|
}
|
|
|
pGroup->AddSubItem(pGroup1);
|
|
|
}
|
|
|
}
|
|
|
{
|
|
|
CMFCPropertyGridProperty* pGroup1 = new CMFCPropertyGridProperty(_T("大幅面加工"));
|
|
|
if(gAuthorityMgr->CheckAuthority(_FACTORY))
|
|
|
{
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_bStretchDataToRealSize");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_bStretchDataToRealSize);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("自动拉伸");
|
|
|
Description = _T("是否根据抓取mark 结果自动拉伸产品尺寸");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_bStretchDataToRealSize, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_AdjustOffset_X");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_AdjustOffset.x);
|
|
|
pPropertie->SetType(_PROP_TYPE_DOUBLE);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("偏移微调X");
|
|
|
Description = _T("整体数据偏移微调X (mm)");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_AdjustOffset.x, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_AdjustOffset_Y");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_AdjustOffset.y);
|
|
|
pPropertie->SetType(_PROP_TYPE_DOUBLE);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("偏移微调Y");
|
|
|
Description = _T("整体数据偏移微调Y(mm)");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_AdjustOffset.y, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_SizeAdjust_X");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_SizeAdjust.x);
|
|
|
pPropertie->SetType(_PROP_TYPE_DOUBLE);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("尺寸微调X");
|
|
|
Description = _T("产品尺寸微调X (mm)");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_SizeAdjust.x, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_SizeAdjust_Y");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_SizeAdjust.y);
|
|
|
pPropertie->SetType(_PROP_TYPE_DOUBLE);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("尺寸微调Y");
|
|
|
Description = _T("产品尺寸微调Y(mm)");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_SizeAdjust.y, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
#if 0
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_RotatoAdjust");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_RotatoAdjust);
|
|
|
pPropertie->SetType(_PROP_TYPE_DOUBLE);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("旋转调整");
|
|
|
Description = _T("旋转调整(mm)");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_RotatoAdjust, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
#endif
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_bFocalAdjust");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_bFocalAdjust);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("实时变焦");
|
|
|
Description = _T("加工的时候是否实时调整焦距,用于加工比较厚的产品(并且Z 轴电动)");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_bFocalAdjust, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_FocalAdjustCnt");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_FocalAdjustCnt);
|
|
|
pPropertie->SetType(_PROP_TYPE_INT);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("变焦次数");
|
|
|
Description = _T("用于比较厚的产品,加工一次调整焦距，再次加工");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_FocalAdjustCnt, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_FocalAdjustDis");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_FocalAdjustDis);
|
|
|
pPropertie->SetType(_PROP_TYPE_DOUBLE);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("变焦距离");
|
|
|
Description = _T("对应变焦次数每次焦距调整的距离,向上为正,向下为负(单位:mm)");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_FocalAdjustDis, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_bConnectObj");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_bConnectObj);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("连接obj 数据");
|
|
|
Description = _T("是否连接多个obj 的数据");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_bConnectObj, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_ConcentricCnt");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_ConcentricCnt);
|
|
|
pPropertie->SetType(_PROP_TYPE_INT);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("同心数量");
|
|
|
Description = _T("创建同心数据的数量,等于1 的时候只有一个圆,间隔就可以调整obj 数据的尺寸");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_ConcentricCnt, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_FirstGap");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_FirstGap);
|
|
|
pPropertie->SetType(_PROP_TYPE_DOUBLE);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("Frist 拉伸间隔");
|
|
|
Description = _T("改变原件尺寸的间隔");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_FirstGap, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_ConcentricGap");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_ConcentricGap);
|
|
|
pPropertie->SetType(_PROP_TYPE_DOUBLE);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("同心间隔");
|
|
|
Description = _T("创建同心数据的间隔mm(大于0 向外)");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_ConcentricGap, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_bBackToProductPt");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_bBackToProductPt);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("回上料点");
|
|
|
Description = _T("加工完成后平台是否返回上料点");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_bBackToProductPt, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
pGroup->AddSubItem(pGroup1);
|
|
|
}
|
|
|
}
|
|
|
{
|
|
|
CMFCPropertyGridProperty* pGroup1 = new CMFCPropertyGridProperty(_T("平台切割"));
|
|
|
if(gAuthorityMgr->CheckAuthority(_FACTORY))
|
|
|
{
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_bUseLaser");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_bUseLaser);
|
|
|
pPropertie->SetType(_PROP_TYPE_BOOL);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("开关激光");
|
|
|
Description = _T("为FALSE 的时候只移动平台");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_bUseLaser, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
pGroup->AddSubItem(pGroup1);
|
|
|
}
|
|
|
}
|
|
|
{
|
|
|
CMFCPropertyGridProperty* pGroup1 = new CMFCPropertyGridProperty(_T("振镜校准"));
|
|
|
if(gAuthorityMgr->CheckAuthority(_FACTORY))
|
|
|
{
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_CalibrationRange");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_CalibrationRange);
|
|
|
pPropertie->SetType(_PROP_TYPE_DOUBLE);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("校准范围");
|
|
|
Description = _T("振镜校准的范围(mm)");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_CalibrationRange, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
{
|
|
|
//添加属性变量映射
|
|
|
Name = _T("m_CalibrationPointGap");//变量名字
|
|
|
CPropertie *pPropertie = new CPropertie;
|
|
|
pPropertie->SetpVal((void*)&m_CalibrationPointGap);
|
|
|
pPropertie->SetType(_PROP_TYPE_DOUBLE);
|
|
|
pPropertie->SetpModule(this);
|
|
|
pPropertie->SetPath(Path);
|
|
|
pPropertie->SetName(Name);
|
|
|
pPropertie->WriteRead(true);//读取保存的属性
|
|
|
|
|
|
//添加属性显示
|
|
|
PropertyName = _T("点间距");
|
|
|
Description = _T("测量打点之间的间隔(mm)");
|
|
|
CMFCPropertyGridProperty* p = new CMFCPropertyGridProperty(PropertyName, (_variant_t)m_CalibrationPointGap, Description);
|
|
|
pGroup1->AddSubItem(p);
|
|
|
gDevicePropertieMgr.Insert(p, pPropertie);
|
|
|
}
|
|
|
pGroup->AddSubItem(pGroup1);
|
|
|
}
|
|
|
}
|
|
|
}
|
|
|
return pGroup;
|
|
|
}
|
|
|
void CCommonFlowMgr::Ini()
|
|
|
{
|
|
|
m_CurCamera = gCameraHawkvis;//绑定当前使用的相机
|
|
|
}
|
|
|
#if 1
|
|
|
void CCommonFlowMgr::WriteWorkFileExt(vector<CLab> &LabVec)
|
|
|
{
|
|
|
LabVec.push_back(CLab(LAB_ONE_OBJ_CUT_TIMES,m_OneObjMarkCnt));
|
|
|
LabVec.push_back(CLab(LAB_SPECIAL_ONE_OBJ_CUT_TIMES,m_SpecialOneObjMarkCnt));
|
|
|
LabVec.push_back(CLab(LAB_ONE_AREA_CUT_TIMES,m_AreaCycleCnt));
|
|
|
LabVec.push_back(CLab(LAB_ONE_CUT_SPEED,m_CutSpeed));
|
|
|
LabVec.push_back(CLab(LAB_ADJUST_OFFSET_X,m_ProductOffset.x));
|
|
|
LabVec.push_back(CLab(LAB_ADJUST_OFFSET_Y,m_ProductOffset.y));
|
|
|
}
|
|
|
void CCommonFlowMgr::ReadWorkFile(CLabVecRang &LabVecRang)
|
|
|
{
|
|
|
CWorkFileMgr WorkFileMgr;
|
|
|
{
|
|
|
CLab Lab = WorkFileMgr.FindLab(LabVecRang,LAB_ONE_OBJ_CUT_TIMES);
|
|
|
if(Lab.m_ValType != _TYPE_NULL)
|
|
|
{
|
|
|
m_OneObjMarkCnt = Lab.m_Int;
|
|
|
}
|
|
|
}
|
|
|
{
|
|
|
CLab Lab = WorkFileMgr.FindLab(LabVecRang,LAB_SPECIAL_ONE_OBJ_CUT_TIMES);
|
|
|
if(Lab.m_ValType != _TYPE_NULL)
|
|
|
{
|
|
|
m_SpecialOneObjMarkCnt = Lab.m_Int;
|
|
|
}
|
|
|
}
|
|
|
{
|
|
|
CLab Lab = WorkFileMgr.FindLab(LabVecRang,LAB_ONE_AREA_CUT_TIMES);
|
|
|
if(Lab.m_ValType != _TYPE_NULL)
|
|
|
{
|
|
|
m_AreaCycleCnt = Lab.m_Int;
|
|
|
}
|
|
|
}
|
|
|
{
|
|
|
CLab Lab = WorkFileMgr.FindLab(LabVecRang,LAB_ONE_CUT_SPEED);
|
|
|
if(Lab.m_ValType != _TYPE_NULL)
|
|
|
{
|
|
|
m_CutSpeed = Lab.m_Int;
|
|
|
}
|
|
|
}
|
|
|
{
|
|
|
CLab Lab = WorkFileMgr.FindLab(LabVecRang,LAB_ADJUST_OFFSET_X);
|
|
|
if(Lab.m_ValType != _TYPE_NULL)
|
|
|
{
|
|
|
m_ProductOffset.x = Lab.m_Double;
|
|
|
}
|
|
|
}
|
|
|
{
|
|
|
CLab Lab = WorkFileMgr.FindLab(LabVecRang,LAB_ADJUST_OFFSET_Y);
|
|
|
if(Lab.m_ValType != _TYPE_NULL)
|
|
|
{
|
|
|
m_ProductOffset.y = Lab.m_Double;
|
|
|
}
|
|
|
}
|
|
|
}
|
|
|
#endif
|
|
|
|
|
|
#if 1
|
|
|
bool CCommonFlowMgr::StartWorkConfirm(bool bSelMark)
|
|
|
{
|
|
|
if(!m_bStartWorkMsg)
|
|
|
return true;
|
|
|
|
|
|
CString str;
|
|
|
if(bSelMark)
|
|
|
str = "开始选择切割?";
|
|
|
else
|
|
|
str = "开始全部切割?";
|
|
|
|
|
|
CMsgBox MsgBox;
|
|
|
return MsgBox.ConfirmOkCancel(str);
|
|
|
}
|
|
|
//是否需要再次执行
|
|
|
bool CCommonFlowMgr::IsNeedExecAgain()
|
|
|
{
|
|
|
//查询的是否累加当前次数
|
|
|
m_CurWorkExecTimes++;
|
|
|
if(m_CurWorkExecTimes>=m_AllWorkExecTimes)
|
|
|
{
|
|
|
m_CurWorkExecTimes = 0;//重置
|
|
|
return false;
|
|
|
}
|
|
|
return true;
|
|
|
}
|
|
|
//设置警示灯
|
|
|
void CCommonFlowMgr::SetLightStateCmd(CWorkCmdContainer &CmdContainer,bool bStart)
|
|
|
{
|
|
|
if(!m_bSetLightState)
|
|
|
return;
|
|
|
#if 1
|
|
|
if(bStart)
|
|
|
{
|
|
|
//关闭所有灯和蜂鸣器
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdPciPortSwitch(PCI_PORT_LIGHT_R,false);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdPciPortSwitch(PCI_PORT_LIGHT_Y,false);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdPciPortSwitch(PCI_PORT_LIGHT_G,false);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdPciPortSwitch(PCI_PORT_ALARM,false);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
}
|
|
|
else//结束
|
|
|
{
|
|
|
//亮黄灯------------------------------------
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdPciPortSwitch(PCI_PORT_LIGHT_Y,true);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdPciPortSwitch(PCI_PORT_LIGHT_R,false);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdPciPortSwitch(PCI_PORT_LIGHT_G,false);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//蜂鸣器提示-----------------------------
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdPciPortSwitch(PCI_PORT_ALARM,true);
|
|
|
pCmd->SetAfterDelay(m_AlamDelay);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdPciPortSwitch(PCI_PORT_ALARM,false);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
}
|
|
|
#endif
|
|
|
|
|
|
|
|
|
}
|
|
|
//设置警示灯
|
|
|
void CCommonFlowMgr::SetLightStateCmd(bool bStart)
|
|
|
{
|
|
|
if(!m_bSetLightState)
|
|
|
return;
|
|
|
|
|
|
CCommPortMgr com;
|
|
|
//打开串口
|
|
|
if(com.Open(gPlcIOMgr->GetComPort(),115200)==false)
|
|
|
{
|
|
|
return;
|
|
|
}
|
|
|
CString strY = "$(KQ1)#";//黄灯
|
|
|
CString strG = "$(KQ2)#";//绿灯
|
|
|
CString strR = "$(KQ3)#";//红灯
|
|
|
|
|
|
CString str;
|
|
|
com.Write(str);
|
|
|
if(bStart)
|
|
|
{
|
|
|
str = strG +char(13)+char(10);
|
|
|
com.Write(str);
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
str = strR +char(13)+char(10);
|
|
|
com.Write(str);
|
|
|
Sleep(m_AlamDelay);
|
|
|
str = strY +char(13)+char(10);
|
|
|
com.Write(str);
|
|
|
}
|
|
|
com.Close();
|
|
|
}
|
|
|
|
|
|
//初始化设备(平台,Z 轴)
|
|
|
bool CCommonFlowMgr::InitDevice()
|
|
|
{
|
|
|
CMsgBox MsgBox;
|
|
|
if(m_bIniConfirmMsgBox)
|
|
|
{
|
|
|
if(MsgBox.ConfirmOkCancel(_T("初始化设备?"))==false)
|
|
|
return false;
|
|
|
}
|
|
|
|
|
|
CDeviceState &DeviceState = CDeviceState::GetInstance();
|
|
|
DeviceState.SetIniState(false);
|
|
|
|
|
|
//初始化的时候不检查平台范围
|
|
|
bool OldbUseMoveRange = gPlatformXY->GetbUseMoveRange();
|
|
|
gPlatformXY->SetbUseMoveRange(false);
|
|
|
|
|
|
//关闭激光端口
|
|
|
gPciCh365Mgr->CloseLaserPort();
|
|
|
|
|
|
gLogMgr->WriteDebugLog("Fuc---->InitDevice");
|
|
|
|
|
|
CWorkCmdInvoker Invoker;
|
|
|
CWorkCmdContainer &CmdContainer = CWorkCmdContainer::GetInstance();//指令集
|
|
|
CmdContainer.Clear();
|
|
|
|
|
|
//设置电机速度
|
|
|
{
|
|
|
CWorkCmdSetMotorSpeed *pCmd = new CWorkCmdSetMotorSpeed();
|
|
|
pCmd->SetbSetMotorX();
|
|
|
pCmd->SetbSetMotorX2();
|
|
|
pCmd->SetbSetMotorY();
|
|
|
pCmd->SetbSetMotorZ();
|
|
|
pCmd->SetSpeedType(_SpeedType_Org);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//反向移动一段距离
|
|
|
if(m_bIniMotorZ)
|
|
|
{
|
|
|
CMotor *pMotorZ = CMotor::GetMotor(MOTOR_Z);
|
|
|
double Dis = pMotorZ->GetReverseMoveDis();
|
|
|
CWorkCmdMoveMotor *pCmd = new CWorkCmdMoveMotor(*pMotorZ,Dis);
|
|
|
pCmd->SetMoveFlg(true);//移动一段距离
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
if(m_bIniMotorZ)//等待移动结束
|
|
|
{
|
|
|
CWorkCmdWaitMotorStop *pCmd = new CWorkCmdWaitMotorStop();
|
|
|
pCmd->SetbWaitMotorZ();
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
if(m_bIniMotorZ)
|
|
|
{
|
|
|
CWorkCmdMotorToMachineOrigin *pCmd = new CWorkCmdMotorToMachineOrigin(*(CMotor::GetMotor("Z")));
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//等待运动结束
|
|
|
if(m_bIniMotorZ)
|
|
|
{
|
|
|
CWorkCmdWaitMotorStop *pCmd = new CWorkCmdWaitMotorStop();
|
|
|
pCmd->SetbWaitMotorZ();
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//XY 平台相关------------------------------------------------------------
|
|
|
if(m_bIniPlatfrom)
|
|
|
{
|
|
|
if(m_bIniMotorX)
|
|
|
{
|
|
|
CWorkCmdMotorToMachineOrigin *pCmd = new CWorkCmdMotorToMachineOrigin(*(CMotor::GetMotor("X")));
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
if(m_bIniMotorX)
|
|
|
{
|
|
|
CWorkCmdMotorToMachineOrigin *pCmd = new CWorkCmdMotorToMachineOrigin(*(CMotor::GetMotor("X2")));
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
if(m_bIniMotorY)
|
|
|
{
|
|
|
CWorkCmdMotorToMachineOrigin *pCmd = new CWorkCmdMotorToMachineOrigin(*(CMotor::GetMotor("Y")));
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//等待运动结束
|
|
|
{
|
|
|
CWorkCmdWaitMotorStop *pCmd = new CWorkCmdWaitMotorStop();
|
|
|
pCmd->SetbWaitMotorX();
|
|
|
pCmd->SetbWaitMotorX2();
|
|
|
pCmd->SetbWaitMotorY();
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//重置所有轴的错误状态
|
|
|
{
|
|
|
CWorkCmdResetAllMotorErr *pCmd = new CWorkCmdResetAllMotorErr();
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
|
|
|
//设置电机速度
|
|
|
{
|
|
|
CWorkCmdSetMotorSpeed *pCmd = new CWorkCmdSetMotorSpeed();
|
|
|
pCmd->SetbSetMotorX();
|
|
|
pCmd->SetbSetMotorX2();
|
|
|
pCmd->SetbSetMotorY();
|
|
|
pCmd->SetbSetMotorZ();
|
|
|
pCmd->SetSpeedType(_SpeedType_Move);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//移动到原点偏移位置
|
|
|
if(m_bIniMotorY)
|
|
|
{
|
|
|
CWorkCmdMotorToOffsetPos *pCmd = new CWorkCmdMotorToOffsetPos(*(CMotor::GetMotor("Y")));
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
if(m_bIniMotorX)
|
|
|
{
|
|
|
CWorkCmdMotorToOffsetPos *pCmd = new CWorkCmdMotorToOffsetPos(*(CMotor::GetMotor("X")));
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
if(m_bIniMotorX)
|
|
|
{
|
|
|
CWorkCmdMotorToOffsetPos *pCmd = new CWorkCmdMotorToOffsetPos(*(CMotor::GetMotor("X2")));
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//等待运动结束
|
|
|
{
|
|
|
CWorkCmdWaitMotorStop *pCmd = new CWorkCmdWaitMotorStop();
|
|
|
pCmd->SetbWaitMotorX();
|
|
|
pCmd->SetbWaitMotorX2();
|
|
|
pCmd->SetbWaitMotorY();
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
}
|
|
|
if(m_bIniMotorZ)
|
|
|
{
|
|
|
CWorkCmdMotorToOffsetPos *pCmd = new CWorkCmdMotorToOffsetPos(*(CMotor::GetMotor("Z")));
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//等待运动结束
|
|
|
if(m_bIniMotorZ)
|
|
|
{
|
|
|
CWorkCmdWaitMotorStop *pCmd = new CWorkCmdWaitMotorStop();
|
|
|
pCmd->SetbWaitMotorZ();
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//重置设备状态(设置当前点为原点)
|
|
|
{
|
|
|
CWorkCmdDeviceParReset *pCmd = new CWorkCmdDeviceParReset;
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
|
|
|
//执行指令-----------------------------------------------------
|
|
|
Invoker.ExcuteAllCmd();
|
|
|
//恢复
|
|
|
gPlatformXY->SetbUseMoveRange(OldbUseMoveRange);
|
|
|
|
|
|
bool Ret = !Invoker.IsCancel();
|
|
|
if(Ret)
|
|
|
{
|
|
|
gCameraHawkvis->OpenCamera();
|
|
|
}
|
|
|
return Ret;
|
|
|
}
|
|
|
//普通的振镜打标功能(layer 中的图形数据,平台不移动)
|
|
|
//使用pci 卡(times 加工次数) (CyclicTimes 循环次数)
|
|
|
bool CCommonFlowMgr::NormalMarkByPciCard(bool bSel,int times,int CyclicTimes)
|
|
|
{
|
|
|
gLogMgr->WriteDebugLog("Fuc---->NormalMarkByPciCard : bSel = " + Bool2Str(bSel));
|
|
|
//临时Product
|
|
|
CProduct Product;
|
|
|
//创建一个临时的area
|
|
|
CMarkArea MarkArea(Dbxy(0,0),DbSize(100,100));
|
|
|
//收集加工数据
|
|
|
MarkArea.CollectWorkData(bSel,Product);
|
|
|
|
|
|
if(MarkArea.HasWorkData())
|
|
|
{
|
|
|
for(int k=0;k<CyclicTimes;k++)
|
|
|
{
|
|
|
CWorkCmdInvoker Invoker;
|
|
|
CWorkCmdContainer &CmdContainer = CWorkCmdContainer::GetInstance();//指令集
|
|
|
CmdContainer.Clear();
|
|
|
CWorkCmdMarkArea *pCmd = new CWorkCmdMarkArea(MarkArea);
|
|
|
pCmd->CreatWorkDataByTimes(times);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
//执行指令-----------------------------------------------------
|
|
|
Invoker.ExcuteAllCmd(false);//不要在新线程中执行
|
|
|
if(Invoker.IsCancel())
|
|
|
return false;
|
|
|
}
|
|
|
return true;
|
|
|
}
|
|
|
gLogMgr->WriteDebugLog("Error---->Not Have Wrok Data");
|
|
|
return false;
|
|
|
}
|
|
|
//移动到第一个area (不等待移动结束)
|
|
|
void CCommonFlowMgr::MoveToFirstArea()
|
|
|
{
|
|
|
gLogMgr->WriteDebugLog("Fuc---->MoveToFirstArea");
|
|
|
CWorkCmdContainer CmdContainer;
|
|
|
//第一个area 用空移速度
|
|
|
{
|
|
|
CWorkCmdSetMotorSpeed *pCmd = new CWorkCmdSetMotorSpeed();
|
|
|
if(gMotionCard_PCI1245->GetCurGpIdx() == 0)
|
|
|
pCmd->SetbSetMotorX();
|
|
|
else
|
|
|
pCmd->SetbSetMotorX2();
|
|
|
|
|
|
pCmd->SetbSetMotorY();
|
|
|
pCmd->SetSpeedType(_SpeedType_Move);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
vector<CMarkArea> &AreaVec = gMarkAreaMgr->GetAreaVec();
|
|
|
if(AreaVec.empty())
|
|
|
return;
|
|
|
|
|
|
Dbxy TargetPt = gLaser->GetCoord();//加工中心点
|
|
|
//移动area 中心点到振镜中心
|
|
|
{
|
|
|
Dbxy AreaRealBasePt = AreaVec[0].GetRealBasePt();//移动到实际位置
|
|
|
Dbxy MovePt;//移动点= area 的理论点
|
|
|
MovePt.x = AreaRealBasePt.x;
|
|
|
MovePt.y = AreaRealBasePt.y;
|
|
|
CWorkCmdMovePlatformXY *pCmd = new CWorkCmdMovePlatformXY();
|
|
|
pCmd->MoveToTargetPt(MovePt,TargetPt);
|
|
|
pCmd->InWorkState();
|
|
|
pCmd->SetAfterDelay(500);//执行后强制等待
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
|
|
|
CWorkCmdInvoker Invoker;
|
|
|
Invoker.Excute(CmdContainer);
|
|
|
}
|
|
|
//大幅面拼接打标(平台移动,振镜拼接,数据为obj 对象) (bSel ==true 的时候为选择打标)
|
|
|
bool CCommonFlowMgr::MultipleAreaMark(CProduct &Product,bool bSel)
|
|
|
{
|
|
|
gLogMgr->WriteDebugLog("Fuc---->MultipleAreaMark : bSel = " + Bool2Str(bSel));
|
|
|
|
|
|
//搜集加工数据(这里比较耗费时间)
|
|
|
gMarkAreaMgr->CollectWorkData(bSel,Product);
|
|
|
if(!gMarkAreaMgr->HasWorkData())
|
|
|
return false;
|
|
|
//是否需要自动回原点
|
|
|
//bool bAutoFindOrigin = (m_FindOriginTimes>0 && m_CurWorktimes>=m_FindOriginTimes && Product.IsbLastOne());
|
|
|
|
|
|
//重置所有obj 的marked 状态
|
|
|
// gObjComponentMgr->ResetAllMarkedState();
|
|
|
|
|
|
/* CWorkCmdInvoker Invoker;
|
|
|
CWorkCmdContainer &CmdContainer = CWorkCmdContainer::GetInstance();//指令集
|
|
|
CmdContainer.Clear();*/
|
|
|
|
|
|
/* //开始之前的工作
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdWorkStart();
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
|
|
|
SetLightStateCmd(CmdContainer,true);//警示灯
|
|
|
//加工时亮绿灯-----------------------------------------
|
|
|
if(m_bSetLightState)
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdPciPortSwitch(PCI_PORT_LIGHT_G,true);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
if(m_bVacuum)//打开真空吸附
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdPciPortSwitch(PCI_PORT_VACUUM_OUT1,true);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//等待运动结束
|
|
|
{
|
|
|
CWorkCmdWaitMotorStop *pCmd = new CWorkCmdWaitMotorStop();
|
|
|
if(gMotionCard_PCI1245->GetCurGpIdx() == 0)
|
|
|
pCmd->SetbWaitMotorX();
|
|
|
else
|
|
|
pCmd->SetbWaitMotorX2();
|
|
|
pCmd->SetbWaitMotorY();
|
|
|
pCmd->SetbCheckActCoord();//检测实际光栅尺的坐标
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//切换为工作速度
|
|
|
{
|
|
|
CWorkCmdSetMotorSpeed *pCmd = new CWorkCmdSetMotorSpeed();
|
|
|
if(gMotionCard_PCI1245->GetCurGpIdx() == 0)
|
|
|
pCmd->SetbSetMotorX();
|
|
|
else
|
|
|
pCmd->SetbSetMotorX2();
|
|
|
|
|
|
pCmd->SetbSetMotorY();
|
|
|
pCmd->SetSpeedType(_SpeedType_Work);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
|
|
|
|
|
|
/ * if(m_bVacuum)//关闭真空吸附
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdPciPortSwitch(PCI_PORT_VACUUM_OUT1,false);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}* /
|
|
|
//结束之后的工作
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdWorkEnd();
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
|
|
|
//执行指令-----------------------------------------------------
|
|
|
Invoker.ExcuteAllCmd();
|
|
|
|
|
|
if(Invoker.IsCancel())
|
|
|
return false;
|
|
|
if(!bSel)//记录工作次数
|
|
|
{
|
|
|
gProductMgr->WorkTimesInc();
|
|
|
}*/
|
|
|
|
|
|
gProductMgr->WorkTimesInc();
|
|
|
return true;//全部加工一次才返回true
|
|
|
}
|
|
|
//通过平台走位来切割layer 中的图形(激光不动,只动平台)
|
|
|
bool CCommonFlowMgr::CutShapeByPlatform(CProduct &Product,bool bSel)
|
|
|
{
|
|
|
gLogMgr->WriteDebugLog("Fuc---->CutShapeByPlatform : bSel = " + Bool2Str(bSel));
|
|
|
//搜集加工数据----------------------------
|
|
|
gMarkAreaMgr->CollectWorkData(bSel,Product);
|
|
|
if(!gMarkAreaMgr->HasWorkData())
|
|
|
return false;
|
|
|
|
|
|
CWorkCmdInvoker Invoker;
|
|
|
CWorkCmdContainer &CmdContainer = CWorkCmdContainer::GetInstance();//指令集
|
|
|
CmdContainer.Clear();
|
|
|
|
|
|
Dbxy TargetPt = gLaser->GetCoord();//加工中心点
|
|
|
//使用数据来创建工作流程
|
|
|
vector<CMarkArea> &AreaVec = gMarkAreaMgr->GetAreaVec();
|
|
|
vector<CMarkArea>::iterator iter = AreaVec.begin();
|
|
|
vector<CMarkArea>::iterator iter_end = AreaVec.end();
|
|
|
for(;iter!=iter_end;iter++)
|
|
|
{
|
|
|
vector<vector<Dbxy>> &Vec = (*iter).GetDataVec();
|
|
|
vector<vector<Dbxy>>::iterator iter1 = Vec.begin();
|
|
|
vector<vector<Dbxy>>::iterator iter1_end = Vec.end();
|
|
|
for(int i=0;iter1!=iter1_end;i++,iter1++)
|
|
|
{
|
|
|
vector<Dbxy>::iterator iter2 = (*iter1).begin();
|
|
|
vector<Dbxy>::iterator iter2_end = (*iter1).end();
|
|
|
for(;iter2!=iter2_end;iter2++)
|
|
|
{
|
|
|
//移动平台---------------------------------------------
|
|
|
{
|
|
|
CWorkCmdMovePlatformXY *pCmd = new CWorkCmdMovePlatformXY();
|
|
|
pCmd->MoveToTargetPt((*iter2),TargetPt);
|
|
|
if(iter2 != (*iter1).begin())//移动到第一个点是空移
|
|
|
{
|
|
|
pCmd->InWorkState();//其他点是工作点
|
|
|
}
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
if(m_bUseLaser)
|
|
|
{
|
|
|
if(iter2==(*iter1).begin())//开激光
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdPciPortSwitch(PCI_PORT_LASER,true);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
}
|
|
|
}
|
|
|
if(m_bUseLaser)//关激光
|
|
|
{
|
|
|
CWorkCmd *pCmd = new CWorkCmdPciPortSwitch(PCI_PORT_LASER,false);
|
|
|
pCmd->CanNotCancel();//不能取消
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
}
|
|
|
}
|
|
|
//执行指令-----------------------------------------------------
|
|
|
Invoker.ExcuteAllCmd();
|
|
|
return !Invoker.IsCancel();
|
|
|
}
|
|
|
#endif
|
|
|
#if 1
|
|
|
//CCD 识别触发,并计算连续两个点的距离
|
|
|
bool CCommonFlowMgr::CameraCatch()
|
|
|
{
|
|
|
CCamera &Camera = *m_CurCamera;
|
|
|
CWorkCmdInvoker Invoker;
|
|
|
CWorkCmdContainer &CmdContainer = CWorkCmdContainer::GetInstance();//指令集
|
|
|
CmdContainer.Clear();
|
|
|
|
|
|
vector<Dbxy> ResultVec;
|
|
|
//抓取--------------------------------------------------------
|
|
|
{
|
|
|
CWorkCmdCameraCatch *pCmd = new CWorkCmdCameraCatch(Camera);
|
|
|
pCmd->SetResultVec(ResultVec);//绑定结果容器
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//执行指令-----------------------------------------------------
|
|
|
Invoker.ExcuteAllCmd(false);//不要在新线程中执行
|
|
|
|
|
|
if(!ResultVec.empty())
|
|
|
{
|
|
|
gMeasureMgr.SetNewPt(ResultVec[0]);//设置测量点
|
|
|
}
|
|
|
return true;
|
|
|
}
|
|
|
//抓取两个mark 点,计算产品的偏移和旋转(结果保存在Product )
|
|
|
bool CCommonFlowMgr::CameraCatchTwoMark()
|
|
|
{
|
|
|
CDeviceState &DeviceState = CDeviceState::GetInstance();
|
|
|
if(!DeviceState.CheckInitState())
|
|
|
return false;
|
|
|
|
|
|
bool ret = true;
|
|
|
vector<CProduct> &ProductVec = gProductMgr->GetProductVec();
|
|
|
int size = ProductVec.size();
|
|
|
for(int i=0;i<size;i++)
|
|
|
{
|
|
|
CProduct &Product = ProductVec[i];
|
|
|
Dbxy MarkPt1;
|
|
|
Dbxy MarkPt2;
|
|
|
if(gObjComponentMgr->GetTwoMarkPt(MarkPt1,MarkPt2))//获取定位点
|
|
|
{
|
|
|
Product.SetTheoryMarkPt(MarkPt1,MarkPt2);//设置定位点
|
|
|
CameraCatchMarkExt(Product);
|
|
|
}
|
|
|
else//没有两个定位点
|
|
|
{
|
|
|
ret = false;
|
|
|
//设置默认偏移
|
|
|
Product.UseDefualtOffset();
|
|
|
break;
|
|
|
}
|
|
|
}
|
|
|
return ret;
|
|
|
}
|
|
|
void CCommonFlowMgr::CameraCatchTwoMark(CProduct &Product)
|
|
|
{
|
|
|
gLogMgr->WriteDebugLog("CCommonFlowMgr::CameraCatchTwoMark");
|
|
|
Dbxy MarkPt1;
|
|
|
Dbxy MarkPt2;
|
|
|
if(gObjComponentMgr->GetTwoMarkPt(MarkPt1,MarkPt2))//从ObjComponent 中获取定位点
|
|
|
{
|
|
|
Product.SetTheoryMarkPt(MarkPt1,MarkPt2);//设置定位点
|
|
|
CameraCatchMarkExt(Product);
|
|
|
}
|
|
|
else//没有两个定位点
|
|
|
{
|
|
|
//设置默认偏移
|
|
|
Product.UseDefualtOffset();
|
|
|
}
|
|
|
}
|
|
|
//识别定位点3
|
|
|
bool CCommonFlowMgr::CameraCatchMark3(CProduct &Product)
|
|
|
{
|
|
|
CCamera &Camera = *m_CurCamera;
|
|
|
gLogMgr->WriteDebugLog("Fuc---->CameraCatchMark3");
|
|
|
//获取mark 坐标的大致位置
|
|
|
Dbxy MarkPt3;
|
|
|
//移动目标点(ccd 的中心)
|
|
|
Dbxy CameraPt = Camera.GetCenterPt();
|
|
|
|
|
|
CWorkCmdInvoker Invoker;
|
|
|
CWorkCmdContainer &CmdContainer = CWorkCmdContainer::GetInstance();//指令集
|
|
|
CmdContainer.Clear();
|
|
|
//设置电机移动速度
|
|
|
{
|
|
|
CWorkCmdSetMotorSpeed *pCmd = new CWorkCmdSetMotorSpeed();
|
|
|
if(gMotionCard_PCI1245->GetCurGpIdx() == 0)
|
|
|
pCmd->SetbSetMotorX();
|
|
|
else
|
|
|
pCmd->SetbSetMotorX2();
|
|
|
pCmd->SetbSetMotorY();
|
|
|
pCmd->SetSpeedType(_SpeedType_Move);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//如果有mark3 先识别mark3
|
|
|
Product.SetbHasMarkPt3(false);
|
|
|
if(gObjComponentMgr->GetMark3Pt(MarkPt3))
|
|
|
{
|
|
|
Product.SetbHasMarkPt3(true);
|
|
|
Product.SetTheoryMark3Pt(MarkPt3);
|
|
|
//移动mark 1 到CCD 中心
|
|
|
{
|
|
|
CWorkCmdMovePlatformXY *pCmd = new CWorkCmdMovePlatformXY();
|
|
|
pCmd->MoveToTargetPt(MarkPt3,CameraPt);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//等待运动结束
|
|
|
{
|
|
|
CWorkCmdWaitMotorStop *pCmd = new CWorkCmdWaitMotorStop();
|
|
|
if(gMotionCard_PCI1245->GetCurGpIdx() == 0)
|
|
|
pCmd->SetbWaitMotorX();
|
|
|
else
|
|
|
pCmd->SetbWaitMotorX2();
|
|
|
pCmd->SetbWaitMotorY();
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//抓取mark 点3
|
|
|
{
|
|
|
CWorkCmdCameraCatch *pCmd = new CWorkCmdCameraCatch(Camera);
|
|
|
pCmd->SetFrontDelay(Camera.GetCatchFrontDelay());
|
|
|
pCmd->SetProduct(Product);
|
|
|
pCmd->SetbCatchMark3(true);//标识抓取mark3
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
}
|
|
|
//执行指令-----------------------------------------------------
|
|
|
Invoker.ExcuteAllCmd(false);//不要在新线程中执行
|
|
|
if(Invoker.IsCancel())//中断的时候重置
|
|
|
{
|
|
|
Product.ResetRealMarkPt();
|
|
|
return false;
|
|
|
}
|
|
|
return true;
|
|
|
}
|
|
|
|
|
|
void CCommonFlowMgr::MarkAreaByIdx(int AreaIndex)
|
|
|
{
|
|
|
vector<CMarkArea> &AreaVec = gMarkAreaMgr->GetAreaVec();
|
|
|
if (AreaVec.size()==0)
|
|
|
{
|
|
|
gLogMgr->WriteDebugLog("No Mark Data.");
|
|
|
return;
|
|
|
}
|
|
|
if (AreaVec[AreaIndex].HasWorkData())//只加工有数据的area
|
|
|
{
|
|
|
CWorkCmdInvoker Invoker;
|
|
|
CWorkCmdContainer &CmdContainer = CWorkCmdContainer::GetInstance();//指令集
|
|
|
CmdContainer.Clear();
|
|
|
CWorkCmdMarkArea *pCmd = new CWorkCmdMarkArea(AreaVec[AreaIndex]);
|
|
|
//pCmd->SetbSelMark(bSel);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
Invoker.ExcuteAllCmd();
|
|
|
}
|
|
|
|
|
|
}
|
|
|
|
|
|
bool CCommonFlowMgr::CameraCatchMarkExt(CProduct &Product)
|
|
|
{
|
|
|
CCamera &Camera = *m_CurCamera;
|
|
|
gLogMgr->WriteDebugLog("Fuc---->CameraCatchTwoMark");
|
|
|
//获取mark 坐标的大致位置
|
|
|
Dbxy MarkPt1,MarkPt2,MarkPt3;
|
|
|
Product.GetMarkCoord(MarkPt1,MarkPt2);
|
|
|
//移动目标点(ccd 的中心)
|
|
|
Dbxy CameraPt = Camera.GetCenterPt();
|
|
|
|
|
|
CWorkCmdInvoker Invoker;
|
|
|
CWorkCmdContainer &CmdContainer = CWorkCmdContainer::GetInstance();//指令集
|
|
|
CmdContainer.Clear();
|
|
|
//设置电机移动速度
|
|
|
{
|
|
|
CWorkCmdSetMotorSpeed *pCmd = new CWorkCmdSetMotorSpeed();
|
|
|
if(gMotionCard_PCI1245->GetCurGpIdx() == 0)
|
|
|
pCmd->SetbSetMotorX();
|
|
|
else
|
|
|
pCmd->SetbSetMotorX2();
|
|
|
pCmd->SetbSetMotorY();
|
|
|
pCmd->SetSpeedType(_SpeedType_Move);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//识别mark1 和mark2
|
|
|
if(!Product.IsSetRealMarkPt1() || (Product.IsSetRealMarkPt1() && Product.IsSetRealMarkPt2()))
|
|
|
{
|
|
|
//移动mark 1 到CCD 中心
|
|
|
{
|
|
|
CWorkCmdMovePlatformXY *pCmd = new CWorkCmdMovePlatformXY();
|
|
|
pCmd->MoveToTargetPt(MarkPt1,CameraPt);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//等待运动结束
|
|
|
{
|
|
|
CWorkCmdWaitMotorStop *pCmd = new CWorkCmdWaitMotorStop();
|
|
|
if(gMotionCard_PCI1245->GetCurGpIdx() == 0)
|
|
|
pCmd->SetbWaitMotorX();
|
|
|
else
|
|
|
pCmd->SetbWaitMotorX2();
|
|
|
pCmd->SetbWaitMotorY();
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//抓取mark 点1
|
|
|
{
|
|
|
CWorkCmdCameraCatch *pCmd = new CWorkCmdCameraCatch(Camera);
|
|
|
pCmd->SetFrontDelay(Camera.GetCatchFrontDelay());
|
|
|
pCmd->SetProduct(Product);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
//移动mark 2 到CCD 中心
|
|
|
{
|
|
|
CWorkCmdMovePlatformXY *pCmd = new CWorkCmdMovePlatformXY();
|
|
|
pCmd->MoveToTargetPt(MarkPt2,CameraPt);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//等待运动结束
|
|
|
{
|
|
|
CWorkCmdWaitMotorStop *pCmd = new CWorkCmdWaitMotorStop();
|
|
|
if(gMotionCard_PCI1245->GetCurGpIdx() == 0)
|
|
|
pCmd->SetbWaitMotorX();
|
|
|
else
|
|
|
pCmd->SetbWaitMotorX2();
|
|
|
pCmd->SetbWaitMotorY();
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//抓取mark 点2
|
|
|
{
|
|
|
CWorkCmdCameraCatch *pCmd = new CWorkCmdCameraCatch(Camera);
|
|
|
pCmd->SetProduct(Product);
|
|
|
pCmd->SetFrontDelay(Camera.GetCatchFrontDelay());
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
}
|
|
|
//执行指令-----------------------------------------------------
|
|
|
Invoker.ExcuteAllCmd(false);//不要在新线程中执行
|
|
|
if(Invoker.IsCancel())//中断的时候重置
|
|
|
{
|
|
|
Product.ResetRealMarkPt();
|
|
|
}
|
|
|
return true;
|
|
|
}
|
|
|
|
|
|
/*测量校准用的vision.data
|
|
|
这个功能就是在marking_pci 不能测量时使用
|
|
|
1.先用marking_pci 软件打出校准点
|
|
|
2.用我的软件移动到第一个测量点(左下角)
|
|
|
3.开始测量即可得到vision.dat
|
|
|
4.再用marking_pci 去生成校准文件
|
|
|
*/
|
|
|
bool CCommonFlowMgr::AutoMeasureVisionData()
|
|
|
{
|
|
|
gLogMgr->WriteDebugLog("func---->AutoMeasureVisionData");
|
|
|
//创建移动点坐标序列
|
|
|
vector<Dbxy> PtVec;
|
|
|
Dbxy CurPlatCoord = gPlatformXY->GetCoord();//当前平台坐标
|
|
|
int PtCnt = m_CalibrationRange/m_CalibrationPointGap+1;//一个方向的移动点数
|
|
|
|
|
|
CString LogStr;
|
|
|
LogStr.Format(_T("[振镜范围] = [%f] ,[点间隔] = [%f]"),m_CalibrationRange,m_CalibrationPointGap);
|
|
|
gLogMgr->WriteDebugLog(LogStr);
|
|
|
LogStr.Format(_T("[点数] = [%d]"),PtCnt*PtCnt);
|
|
|
gLogMgr->WriteDebugLog(LogStr);
|
|
|
|
|
|
for(int i=0;i<PtCnt;i++)//列
|
|
|
{
|
|
|
for(int k=0;k<PtCnt;k++)//行
|
|
|
{
|
|
|
Dbxy pt;
|
|
|
pt.x = CurPlatCoord.x - m_CalibrationPointGap*k;
|
|
|
pt.y = CurPlatCoord.y - m_CalibrationPointGap*i;
|
|
|
PtVec.push_back(pt);
|
|
|
}
|
|
|
}
|
|
|
//依次移动平台观察-----------------------------------
|
|
|
vector<Dbxy> ResultVec;//结果
|
|
|
MovePtToCamera(PtVec,ResultVec,true);
|
|
|
//结果输出到vision.dat 文件-----------------------------
|
|
|
if(!ResultVec.empty())
|
|
|
{
|
|
|
CString FilePath;
|
|
|
CFileMgr FileMgr;
|
|
|
FileMgr.GetFullFilePath(FilePath,"\\vision_data.dat");
|
|
|
|
|
|
ofstream file;
|
|
|
file.open(FilePath);
|
|
|
//输出范围和间隔
|
|
|
file<<m_CalibrationRange<<","<<m_CalibrationRange<<","<<m_CalibrationPointGap<<","<<m_CalibrationPointGap;
|
|
|
FileMgr.WriteDbxyVecToFile(ResultVec,&file);
|
|
|
return true;
|
|
|
}
|
|
|
return false;
|
|
|
}
|
|
|
|
|
|
//连续移动平台到一系列坐标，ResultVec保存抓取的结果
|
|
|
void CCommonFlowMgr::MovePtToCamera(vector<Dbxy> &PtVec,vector<Dbxy> &ResultVec,bool bCatch)
|
|
|
{
|
|
|
CCamera &Camera = *m_CurCamera;
|
|
|
|
|
|
CWorkCmdInvoker Invoker;
|
|
|
CWorkCmdContainer &CmdContainer = CWorkCmdContainer::GetInstance();//指令集
|
|
|
CmdContainer.Clear();
|
|
|
|
|
|
vector<Dbxy>::iterator iter = PtVec.begin();
|
|
|
vector<Dbxy>::iterator iter_end = PtVec.end();
|
|
|
for(;iter!=iter_end;iter++)
|
|
|
{
|
|
|
//移动平台-------------------------------------------------
|
|
|
{
|
|
|
CWorkCmdMovePlatformXY *pCmd = new CWorkCmdMovePlatformXY();
|
|
|
pCmd->MoveToTargetPt(Dbxy(0,0),(*iter));
|
|
|
pCmd->InWorkState();//工作速度
|
|
|
pCmd->SetAfterDelay(300);//移动后延时
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//抓取--------------------------------------------------------
|
|
|
if(bCatch)
|
|
|
{
|
|
|
CWorkCmdCameraCatch *pCmd = new CWorkCmdCameraCatch(Camera);
|
|
|
pCmd->SetResultVec(ResultVec);//绑定结果容器
|
|
|
pCmd->SetFrontDelay(Camera.GetCatchFrontDelay());//抓取前延时
|
|
|
pCmd->SetAfterDelay(300);//移动后延时
|
|
|
pCmd->SetbAlam(false);//不要蜂鸣器提示
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
}
|
|
|
//执行指令-----------------------------------------------------
|
|
|
Invoker.ExcuteAllCmd(true);//在新线程中执行
|
|
|
|
|
|
}
|
|
|
//移动一个点到ccd 中心
|
|
|
void CCommonFlowMgr::MovePtToCamera(Dbxy pt)
|
|
|
{
|
|
|
CCamera &Camera = *m_CurCamera;
|
|
|
CWorkCmdInvoker Invoker;
|
|
|
CWorkCmdContainer &CmdContainer = CWorkCmdContainer::GetInstance();//指令集
|
|
|
CmdContainer.Clear();
|
|
|
//移动平台-------------------------------------------------
|
|
|
{
|
|
|
CWorkCmdMovePlatformXY *pCmd = new CWorkCmdMovePlatformXY();
|
|
|
pCmd->MoveToTargetPt(Camera.GetCenterPt(),pt);
|
|
|
pCmd->InWorkState();//工作速度
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//抓取--------------------------------------------------------
|
|
|
{
|
|
|
CWorkCmdCameraCatch *pCmd = new CWorkCmdCameraCatch(Camera);
|
|
|
CmdContainer.AddCmd(pCmd);
|
|
|
}
|
|
|
//执行指令-----------------------------------------------------
|
|
|
Invoker.ExcuteAllCmd(false);
|
|
|
}
|
|
|
//移动一颗obj 到CCD 观察(观察结束后将obj 设置为已观察)
|
|
|
void CCommonFlowMgr::MoveSelObjToCamera(CProduct &Product)
|
|
|
{
|
|
|
gLogMgr->WriteDebugLog("Fuc---->MoveSelObjToCamera");
|
|
|
CCamera &Camera = *m_CurCamera;
|
|
|
|
|
|
bool flg = false;
|
|
|
vector<CObjComponent>&ComponentVec = gObjComponentMgr->GetComponentVec();
|
|
|
vector<CObjComponent>::iterator iter = ComponentVec.begin();
|
|
|
vector<CObjComponent>::iterator iter_end = ComponentVec.end();
|
|
|
for(;iter!=iter_end;iter++)
|
|
|
{
|
|
|
if((*iter).IsSelected())
|
|
|
{
|
|
|
Dbxy pt = (*iter).GetBasePt();
|
|
|
pt = Product.TheoryPtToRealPt(pt);//计算实际位置
|
|
|
MovePtToCamera(pt);//移动观察
|
|
|
(*iter).SetSelected(false);
|
|
|
flg = true;
|
|
|
break;
|
|
|
}
|
|
|
}
|
|
|
if(flg)
|
|
|
GetCurViewPtr()->RefreshView();
|
|
|
}
|
|
|
#endif
|
|
|
void CCommonFlowMgr::SetAdjustOffsetAll(Dbxy Offset)
|
|
|
{
|
|
|
/* m_AdjustOffsetAll.x = Offset.x + m_ProductOffset.x;
|
|
|
m_AdjustOffsetAll.y = Offset.y + m_ProductOffset.y;*/
|
|
|
|
|
|
m_AdjustOffsetAll.x = Offset.x ;
|
|
|
m_AdjustOffsetAll.y = Offset.y ;
|
|
|
}
|
|
|
void CCommonFlowMgr::ResetProductOffset()
|
|
|
{
|
|
|
m_ProductOffset.x = m_ProductOffset.y = 0;
|
|
|
}
|
