public bool CalibRotateCenter(string cellName, Point2D pt2Mark1, Point2D pt2Mark2, double rotateAngle, BaseParComprehensive parComprehensive) { try { //获取旋转中心cell BaseParCalibrate baseParComprehensive = parComprehensive.GetCellParCalibrate(cellName); //获取旋转中心算子 ParCalibRotate parCalibRotate = (ParCalibRotate)baseParComprehensive; //根据参数求旋转中心 Point2D rc = new FunCalibRotate().GetOriginPoint(rotateAngle, pt2Mark1, pt2Mark2); //把旋转中心存入算子 parCalibRotate.XRC = rc.DblValue1; parCalibRotate.YRC = rc.DblValue2; //讲计算结果写入xml parComprehensive.WriteXmlDoc(cellName); //将参数保存到结果类 new FunCalibRotate().SaveParToResult(HtResult_Cam1, parCalibRotate); //输出计算结果 string info = string.Format("相机{0}旋转中心标定完成,X:{1},Y:{2}", g_NoCamera, parCalibRotate.XRC.ToString(), parCalibRotate.YRC.ToString()); ShowState(info); return(true); } catch (Exception ex) { Log.L_I.WriteError(NameClass, ex); return(false); } }
public void DualLocation(int index) { if (Camera1Done & Camera2Done) { ShowState("开始计算工位" + index + "偏差"); BaseParCalibrate baseParComprehensive = ParComprehensive2.P_I.GetCellParCalibrate(Camera2RC); ParCalibRotate parCalibRotate = (ParCalibRotate)baseParComprehensive; double angle = Math.Atan( (Pt2Mark2.DblValue2 - Pt2Mark1.DblValue2) * AMP / Protocols.confDisMark) * 180 / Math.PI - StationDataMngr.CalibPos_L[index - 1].DblValue4; ShowState("工位" + index + "逆时针角度偏差: " + angle); FunCalibRotate fcr = new FunCalibRotate(); Point2D MarkAfterRotate = fcr.GetPoint_AfterRotation( angle / 180 * Math.PI, parCalibRotate.PointRC, Pt2Mark2); double deltaY = MarkAfterRotate.DblValue1 - StationDataMngr.CalibPos_L[index - 1].DblValue1; double deltaX = MarkAfterRotate.DblValue2 - StationDataMngr.CalibPos_L[index - 1].DblValue2; deltaX *= AMP; deltaY *= -AMP; Point2D delta = TransDelta(new Point2D(deltaX, deltaY), Protocols.ConfPlaceAngle, Protocols.ConfPreciseAngle); ShowState(string.Format("工位{0}X方向补偿{1},Y方向补偿{2}", index, delta.DblValue1.ToString(ReserveDigits), delta.DblValue2.ToString(ReserveDigits))); int num = (StationNum - 1) * 2 + index; Point4D pos = new Point4D { DblValue1 = delta.DblValue1 + StationDataMngr.PlacePos_L[index - 1].DblValue1 + ParAdjust.Value1("adj" + num), DblValue2 = delta.DblValue2 + StationDataMngr.PlacePos_L[index - 1].DblValue2 + ParAdjust.Value2("adj" + num), DblValue3 = StationDataMngr.PlacePos_L[index - 1].DblValue3, DblValue4 = Protocols.ConfPlaceAngle + angle + ParAdjust.Value3("adj" + num) }; LogicRobot.L_I.WriteRobotCMD(pos, Protocols.BotCmd_StationPos); ShowState("发送机器人放片坐标:" + pos.DblValue1.ToString("f3") + @"/" + pos.DblValue2.ToString("f3")); } }
public static bool GetRcFromPar(string cellName, BaseParComprehensive parComprehensive, out Point2D rc) { rc = new Point2D(); try { //获取单元格 BaseParCalibrate baseParComprehensive = parComprehensive.GetCellParCalibrate(cellName); //获取旋转中心算子 ParCalibRotate parCalibRotate = (ParCalibRotate)baseParComprehensive; //计算旋转之后的mark位置 rc = parCalibRotate.PointRC; } catch (Exception ex) { Log.L_I.WriteError(ClassName, ex); return(false); } return(true); }
public bool SetRotateCenter(string cellName, Point2D rc, BaseParComprehensive parComprehensive) { //获取旋转中心cell BaseParCalibrate baseParComprehensive = parComprehensive.GetCellParCalibrate(cellName); //获取旋转中心算子 ParCalibRotate parCalibRotate = (ParCalibRotate)baseParComprehensive; //把旋转中心存入算子 parCalibRotate.XRC = rc.DblValue1; parCalibRotate.YRC = rc.DblValue2; //讲计算结果写入xml parComprehensive.WriteXmlDoc(cellName); //将参数保存到结果类 new FunCalibRotate().SaveParToResult(HtResult_Cam1, parCalibRotate); //输出计算结果 string info = string.Format("相机{0}旋转中心标定完成,X:{1},Y:{2}", g_NoCamera, parCalibRotate.XRC.ToString(), parCalibRotate.YRC.ToString()); ShowState(info); return(true); }
public void CalibRC() { Thread.Sleep(500); //double curR= ModuleBase.GetCurAngleByY(Protocols.GlassXInPresize, AMP, Pt2Mark1, Pt2MarkRC); BaseParCalibrate baseParComprehensive = ParComprehensive2.P_I.GetCellParCalibrate(Camera2RC); ParCalibRotate parCalibRotate = (ParCalibRotate)baseParComprehensive; Point2D orgPoint = new FunCalibRotate().GetOriginPoint(Protocols.BotRCCalibAngle, Pt2Mark2, Pt2MarkRC); ShowState("计算旋转中心X:" + orgPoint.DblValue1 + ",Y:" + orgPoint.DblValue2); Point2D offset = new Point2D(Protocols.GlassXInPresize / 2 / AMP, Protocols.GlassYInPresize / 2 / AMP); double r = ModuleBase.GetCurAngleByY(Protocols.GlassXInPresize, AMP, Pt2Mark1, Pt2Mark2); offset = TransDelta(offset, r + 0.5, 0); Point2D rc = new Point2D(offset.DblValue1 + Pt2Mark2.DblValue1, offset.DblValue2 + Pt2Mark2.DblValue2); ShowState("理论旋转中心X:" + rc.DblValue1 + ",Y:" + rc.DblValue2); if (Math.Abs(orgPoint.DblValue1 - rc.DblValue1) < 1000 && Math.Abs(orgPoint.DblValue2 - rc.DblValue2) < 1000) { ShowState("使用计算旋转中心"); parCalibRotate.XRC = orgPoint.DblValue1; parCalibRotate.YRC = orgPoint.DblValue2; } else { ShowState("使用理论旋转中心"); parCalibRotate.XRC = rc.DblValue1; // orgPoint.DblValue1; parCalibRotate.YRC = rc.DblValue2; // orgPoint.DblValue2; } ParComprehensive2.P_I.WriteXmlDoc(Camera2RC); //将参数保存到结果类 new FunCalibRotate().SaveParToResult(HtResult_Cam2, parCalibRotate); ShowState(string.Format("旋转中心标定完成,X_{0},Y_{1}", parCalibRotate.XRC.ToString(), parCalibRotate.YRC.ToString())); LogicRobot.L_I.WriteRobotCMD(Protocols.BotCmd_CalibRC); }
/// <summary> /// 自动校准旋转中心,1401表示位置1第一次拍照, /// </summary> /// <param name="pos">算子序号,不表示拍照位置</param> /// <param name="index"></param> /// <param name="htResult">哈希表结果</param> /// <returns></returns> bool CalibRotate(int pos, int index, out Hashtable htResult) { htResult = null; Stopwatch sw = new Stopwatch(); try { //获取该算子所有的单元格 List <string> nameCell_L = g_BaseParComprehensive.GetAllNameCellByType("旋转中心变换"); if (nameCell_L.Count < pos) { WinMsgBox.ShowMsgBox("算子个数小于序号!"); return(false); } string nameCell = nameCell_L[pos - 1];//单元格名称 ParCalibRotate par = g_BaseParComprehensive.GetCellParCalibrate(nameCell) as ParCalibRotate; int indexCell = int.Parse(nameCell.Replace("C", ""));//单元格索引 ParCellExeReference parCellExeReference = par.g_ParCellExecuteReference; ParGetResultFromCell parGetResultFromCell = par.g_ParGetResultFromCellForRC;//用来计算旋转中心 //调用执行 g_BaseDealComprehensive.DealComprehensivePosCell_ForTestRun(g_UCDisplayCamera, parCellExeReference, par.g_ParCellExecuteReference.g_CellExecute_L, out htResult);//执行算法且显示 string cellError = ""; if (!GetErrorCell(htResult, pos, out cellError)) { WinMsgBox.ShowMsgBox(string.Format("相机{0}位置{1},单元格{2}校准计算错误", g_NoCamera.ToString(), pos.ToString(), par.NameCell)); return(false); } FunCellDataReferenc fun = new FunCellDataReferenc(); fun.GetResultValue(htResult, parGetResultFromCell, index - 1); string info = string.Format("相机{0}位置{1},单元格{2}", g_NoCamera.ToString(), pos.ToString(), par.NameCell); if (index == 1) { info += "旋转中心校准第一次拍照"; ShowState(info); SaveStdImage(par, "旋转中心位置1"); } else if (index == 2) { info += "旋转中心校准第二次拍照"; ShowState(info); SaveStdImage(par, "旋转中心位置2"); FunCalibRotate funCalibRotate = new FunCalibRotate(); Point2D point = funCalibRotate.GetOriginPoint(par); par.XRC = point.DblValue1; par.YRC = point.DblValue2; //显示求取的旋转中心 info = string.Format("旋转中心:X{0},Y{1}", par.XRC.ToString(), par.YRC.ToString()); ShowState(info); //保存此单元格 bool blSave = g_BaseParComprehensive.WriteXmlDoc(par.NameCell); if (blSave) { ShowState(string.Format("将参数旋转中心校准{0}保存到本地成功", par.NameCell)); } else { ShowAlarm(string.Format("将参数旋转中心校准{0}保存到本地失败", par.NameCell)); return(false); } //将参数保存到结果中 bool blSaveResult = g_BaseDealComprehensive.InitCalibRotate(indexCell); if (blSaveResult) { ShowState(string.Format("将参数旋转中心校准{0}保存到结果成功", par.NameCell)); } else { ShowAlarm(string.Format("将参数旋转中心校准{0}保存到结果失败", par.NameCell)); return(false); } } return(true); } catch (Exception ex) { ShowAlarm(string.Format("相机{0}旋转中心计算进入Catch", g_NoCamera.ToString())); Log.L_I.WriteError(NameClass, ex); return(false); } }