//主程序名称 private string GetProgComment(ushort handle, out string error) { error = ""; //获得当前主程序号 Focas1.ODBM macro = new Focas1.ODBM(); short nRet = Focas1.cnc_rdmacro(handle, 4000, 10, macro); if (nRet == Focas1.EW_OK) { Focas1.PRGDIR3 buf1 = new Focas1.PRGDIR3(); double dSmall = macro.dec_val * 1.0; double top_prog = macro.mcr_val / Math.Pow(10.0, dSmall); int ntop_prog = Convert.ToInt32(top_prog); short num_prog = 1; nRet = Focas1.cnc_rdprogdir3(handle, 1, ref ntop_prog, ref num_prog, buf1); if (nRet == Focas1.EW_OK) { return(buf1.dir1.comment); } } error = $"读取错误!错误代号[{nRet}]"; return(""); }
/// <summary> /// Read Machine System Macro Data /// </summary> /// <param name="macroNo">System Macro No</param> private void CallRdMacro(short macroNo) { try { Focas1.ODBM odbM = new Focas1.ODBM(); focasReturn = Focas1.cnc_rdmacro(fanucHandle, macroNo, 10, odbM); if (focasReturn == EW_OK) { base.SetDictionary(base.MACRO_VALUE, macroNo, odbM.mcr_val / Math.Pow((double)10, (double)odbM.dec_val)); LogHandler.WriteLog(base.division, string.Format("{0} :: CallRdMacro(MacroNo = {2}) Success :: VALUE = {1}", this.ToString(), base.MACRO_VALUE[macroNo], macroNo)); } else if (focasReturn == EW_SOCKET) { base.isConnect = false; LogHandler.WriteLog(base.division, string.Format("{0} :: CallRdMacro(MacroNo = {1}) Fail :: SocketError", this.ToString(), macroNo)); } else { LogHandler.WriteLog(base.division, string.Format("{0} :: CallRdMacro(MacroNo = {2}) Fail :: ReturnCode = {1}", this.ToString(), focasReturn, macroNo)); } } catch (Exception ex) { LogHandler.WriteLog(base.division, string.Format("{0} :: CallRdMacro(MacroNo = {2}) Exception :: Message = {1}", this.ToString(), ex.Message, macroNo)); } }
//主程序名称 private static string GetProgComment(string deviceAddress, out string error) { error = ""; //获得当前主程序号 Focas1.ODBM macro = new Focas1.ODBM(); Focas1.PRGDIR3 buf1 = new Focas1.PRGDIR3(); ushort m_handle; short nRet = Focas1.cnc_allclibhndl3(deviceAddress, 8193, 2, out m_handle); if (nRet == Focas1.EW_OK) { nRet = Focas1.cnc_rdmacro(m_handle, 4000, 10, macro); } if (nRet == Focas1.EW_OK) { //**************** double dSmall = macro.dec_val * 1.0; double top_prog = macro.mcr_val / Math.Pow(10.0, dSmall); int ntop_prog = Convert.ToInt32(top_prog); short num_prog = 1; nRet = Focas1.cnc_rdprogdir3(m_handle, 1, ref ntop_prog, ref num_prog, buf1); } if (nRet == Focas1.EW_OK) { Focas1.cnc_freelibhndl(m_handle); //释放连接 return(buf1.dir1.comment); } error = "连接失败"; return(""); }
/* number is variable number to be read. * GetCounter(526);//cnc362 10.1.90.4 GetCounter(511);//cnc422 10.1.90.5 GetCounter(501);//cnc422 10.1.90.2 * */ short GetCounter(short number) { short ret = -1; try { ret = Focas1.cnc_allclibhndl3(fanucIP, 8193, 6, out fanucHandle); if (ret == Focas1.EW_OK) { Console.WriteLine("We are connected!"); } else { // Console.WriteLine("There was an error connecting. Return value: " + _ret); throw new Exception("There was an error connecting. Return value: " + ret); } Focas1.ODBM macro = new Focas1.ODBM(); string strVal; ret = Focas1.cnc_rdmacro(fanucHandle, number, 10, macro); if (ret == Focas1.EW_OK) { // mcr_val = 406000000 // dec_val = 6 // value = 406.000000 strVal = string.Format("{0:d9}", Math.Abs(macro.mcr_val)); if (0 < macro.dec_val) strVal = strVal.Insert(9 - macro.dec_val, "."); if (macro.mcr_val < 0) strVal = "-" + strVal; Console.WriteLine("partCounter={0}", strVal); decimal decimalVal; decimalVal = Convert.ToDecimal(strVal); Console.WriteLine("String converted to decimal = {0} ", decimalVal); partCounter = Convert.ToInt32(decimalVal); // partCounter2 = macro.mcr_val; Console.WriteLine("partCounter.int= {0}", partCounter); } else { throw new Exception("There was an error reading the macro variable. Return value: " + ret); // Console.WriteLine("**********"); } } catch (Exception e) { Console.WriteLine("Exception => {0}", e); } finally { // Free the Focas handle Focas1.cnc_freelibhndl(fanucHandle); Console.WriteLine("Handle has been freed"); } return ret; }
public MacroVariable GetMacroVariable(short variableNumber) { Focas1.ODBM odbm = new Focas1.ODBM(); MacroVariable macroVariable = new MacroVariable(); var readMacroVariableReturnCode = (ReturnCodes.Code)Focas1.cnc_rdmacro(focasHandle, variableNumber, 10, odbm); macroVariable.returnCode = readMacroVariableReturnCode; macroVariable.VariableNumber = variableNumber; macroVariable.VariableValue = ((double)odbm.mcr_val) / Math.Pow(10.0, (double)odbm.dec_val); return(macroVariable); }
//获取宏变量数值,支持小数 private string GetMacroData(ushort handle, short number, out string error) { error = ""; Focas1.ODBM macro = new Focas1.ODBM(); short nRet = Focas1.cnc_rdmacro(handle, number, 10, macro); if (nRet == Focas1.EW_OK) { return((macro.mcr_val * Math.Pow(10, -macro.dec_val)).ToString()); } error = $"读取错误!错误代号[{nRet}]"; return(""); }
//读M_macro地址 private short ReadPmcMacroAddr(short nAddr, out short nRValue) { Focas1.ODBM macro = new Focas1.ODBM(); short ret = Focas1.cnc_rdmacro(Flibhndl, nAddr, 10, macro); if (ret == Focas1.EW_OK) { //**************** // int nRet = -16; double dSmall = macro.dec_val * 1.0; double top_prog = macro.mcr_val / Math.Pow(10.0, dSmall); nRValue = Convert.ToInt16(top_prog); //short num_prog = 1; return(ret); } else { throw new Exception("CNC读取M_macro地址出错" + ret); } }
//------------------------------------------------------------------------------------------------------------------// //---------------------------------- Get Changed Values -----------------------------------------------------------// //------------------------------------------------------------------------------------------------------------------// public void getChangedValues(MachineTool machineTool) { mAdapter.Begin(); // Display if machine is available if (machineTool.connected) { mAvail.Value = "AVAILABLE"; // Display Active Process Focas1.cnc_getpath(machineTool.hFanucMonitor, out path, out maxPath); if (path == 1) { mSelProc.Value = "1"; } else if (path == 2) { mSelProc.Value = "2"; } //-------------------------------------------------------------------------------------------------------------- // Display Active Part Program & Sub-Program short ret2 = Focas1.cnc_rdexecprog(machineTool.hFanucMonitor, ref length, out blkNum, lineData); mBlkNum.Value = blkNum.ToString(); mActiveLine.Value = GetProgramName(lineData, "\n"); //-------------------------------------------------------------------------------------------------------------- Focas1.cnc_rdprgnum(machineTool.hFanucMonitor, subProgram); mSubProgram.Value = subProgram.data.ToString(); //-------------------------------------------------------------------------------------------------------------- int ret = Focas1.cnc_exeprgname(machineTool.hFanucMonitor, mainProgram); //string progName = mainProgram.name.ToString(); mProgram.Value = GetProgramName(mainProgram.name, "\0"); //-------------------------------------------------------------------------------------------------------------- /*uint lineToReadFrom = 1; string progData = string.Empty; uint linesToRead = 5; uint charToRead = 100; Focas1.cnc_rdprogline2(machineTool.hFanucMonitor, mainProgram.o_num, lineToReadFrom, progData, ref linesToRead, ref charToRead);*/ //-------------------------------------------------------------------------------------------------------------- // Display the current selected mode switch (machineTool.fanucStatus.aut) { case 0: { mMode.Value = "MDI"; break; } case 1: { mMode.Value = "AUTO"; break; } case 3: { mMode.Value = "EDIT"; break; } case 4: { mMode.Value = "HAND WHEEL"; break; } case 5: { mMode.Value = "JOG"; break; } case 6: { mMode.Value = "TEACH JOG"; break; } case 7: { mMode.Value = "TEACH HANDLE"; break; } case 8: { mMode.Value = "INC FEED"; break; } case 9: { mMode.Value = "REFERENCE"; break; } case 10: { mMode.Value = "REMOTE"; break; } } //-------------------------------------------------------------------------------------------------------------- // Currently Selected Table mSelTable.Value = 0; //-------------------------------------------------------------------------------------------------------------- // Current Active Tool if (machineTool.gifuChanger == false) { Focas1.pmc_rdpmcrng(machineTool.hFanucMonitor, addrType, dataType, toolData, toolData, dataLength, pmcData); mActiveTool.Value = pmcData.cdata[0].ToString(); } else { Focas1.ODBM macroInfo = new Focas1.ODBM(); Focas1.cnc_rdmacro(machineTool.hFanucMonitor, 276, 10, macroInfo); float toolNum = macroInfo.mcr_val / (10 ^ macroInfo.dec_val); mActiveTool.Value = toolNum.ToString(); } //-------------------------------------------------------------------------------------------------------------- // Display Alarms alarmNum = 10; ret = Focas1.cnc_rdalmmsg2(machineTool.hFanucMonitor, -1, ref alarmNum, alarmMsg); alarm[0] = alarmMsg.msg1.alm_msg; alarm[1] = alarmMsg.msg2.alm_msg; alarm[2] = alarmMsg.msg3.alm_msg; alarm[3] = alarmMsg.msg4.alm_msg; alarm[4] = alarmMsg.msg5.alm_msg; alarm[5] = alarmMsg.msg6.alm_msg; alarm[6] = alarmMsg.msg7.alm_msg; alarm[7] = alarmMsg.msg8.alm_msg; alarm[8] = alarmMsg.msg9.alm_msg; alarm[9] = alarmMsg.msg10.alm_msg; alarm[0] = alarm[0].Substring(0, alarmMsg.msg1.msg_len); alarm[1] = alarm[1].Substring(0, alarmMsg.msg2.msg_len); alarm[2] = alarm[2].Substring(0, alarmMsg.msg3.msg_len); alarm[3] = alarm[3].Substring(0, alarmMsg.msg4.msg_len); alarm[4] = alarm[4].Substring(0, alarmMsg.msg5.msg_len); alarm[5] = alarm[5].Substring(0, alarmMsg.msg6.msg_len); alarm[6] = alarm[6].Substring(0, alarmMsg.msg7.msg_len); alarm[7] = alarm[7].Substring(0, alarmMsg.msg8.msg_len); alarm[8] = alarm[8].Substring(0, alarmMsg.msg9.msg_len); alarm[9] = alarm[9].Substring(0, alarmMsg.msg10.msg_len); alarmType[0] = almType(alarmMsg.msg1.type); alarmType[1] = almType(alarmMsg.msg2.type); alarmType[2] = almType(alarmMsg.msg3.type); alarmType[3] = almType(alarmMsg.msg4.type); alarmType[4] = almType(alarmMsg.msg5.type); alarmType[5] = almType(alarmMsg.msg6.type); alarmType[6] = almType(alarmMsg.msg7.type); alarmType[7] = almType(alarmMsg.msg8.type); alarmType[8] = almType(alarmMsg.msg9.type); alarmType[9] = almType(alarmMsg.msg10.type); alarmNumber[0] = alarmMsg.msg1.alm_no.ToString() + ": "; alarmNumber[1] = alarmMsg.msg2.alm_no.ToString() + ": "; alarmNumber[2] = alarmMsg.msg3.alm_no.ToString() + ": "; alarmNumber[3] = alarmMsg.msg4.alm_no.ToString() + ": "; alarmNumber[4] = alarmMsg.msg5.alm_no.ToString() + ": "; alarmNumber[5] = alarmMsg.msg6.alm_no.ToString() + ": "; alarmNumber[6] = alarmMsg.msg7.alm_no.ToString() + ": "; alarmNumber[7] = alarmMsg.msg8.alm_no.ToString() + ": "; alarmNumber[8] = alarmMsg.msg9.alm_no.ToString() + ": "; alarmNumber[9] = alarmMsg.msg10.alm_no.ToString() + ": "; for (short i = 0; i < alarmType.Length; i++) { if (alarmType[i] == "SW" && alarm[i].ToString() == string.Empty) { alarmType[i] = string.Empty; alarm[i] = string.Empty; alarmNumber[i] = string.Empty; } } mAlarm1.Value = alarmType[0].ToString() + alarmNumber[0] + alarm[0].ToString(); mAlarm2.Value = alarmType[1].ToString() + alarmNumber[1] + alarm[1].ToString(); mAlarm3.Value = alarmType[2].ToString() + alarmNumber[2] + alarm[2].ToString(); mAlarm4.Value = alarmType[3].ToString() + alarmNumber[3] + alarm[3].ToString(); mAlarm5.Value = alarmType[4].ToString() + alarmNumber[4] + alarm[4].ToString(); mAlarm6.Value = alarmType[5].ToString() + alarmNumber[5] + alarm[5].ToString(); mAlarm7.Value = alarmType[6].ToString() + alarmNumber[6] + alarm[6].ToString(); mAlarm8.Value = alarmType[7].ToString() + alarmNumber[7] + alarm[7].ToString(); mAlarm9.Value = alarmType[8].ToString() + alarmNumber[8] + alarm[8].ToString(); mAlarm10.Value = alarmType[9].ToString() + alarmNumber[9] + alarm[9].ToString(); //-------------------------------------------------------------------------------------------------------------- // Clocks Focas1.cnc_rdparam(machineTool.hFanucMonitor, 6758, 0, 8, cycTimeMin); Focas1.cnc_rdparam(machineTool.hFanucMonitor, 6757, 0, 8, cycTimeSec); mCycleTime.Value = cycTimeMin.cdata.ToString() + "." + (cycTimeSec.ldata / 1000).ToString(); //Focas1.cnc_rdtimer(machineTool.hFanucLib, 1, cycleTime); // mOpTime.Value = cycleTime.minute.ToString() + "." + cycleTime.msec.ToString(); //-------------------------------------------------------------------------------------------------------------- // Display Feed, Speed overrides ret = Focas1.pmc_rdpmcrng(machineTool.hFanucMonitor, 0, 0, 96, 96, 16, pmcOverrides); mFeedOv.Value = (255-pmcOverrides.cdata[0]).ToString(); ret = Focas1.pmc_rdpmcrng(machineTool.hFanucMonitor, 0, 0, 30, 30, 16, pmcOverrides); mSpeedOv.Value = pmcOverrides.cdata[0].ToString(); //-------------------------------------------------------------------------------------------------------------- // Display Programmed Feed & Speed mPrgFeed.Value = "0"; mPrgSpeed.Value = "0"; //-------------------------------------------------------------------------------------------------------------- // Check the current feed rates Focas1.ODBACT feedRate = new Focas1.ODBACT(); Focas1.cnc_actf(machineTool.hFanucMonitor, feedRate); mRealFeed.Value = (feedRate.data / 10000).ToString(); //-------------------------------------------------------------------------------------------------------------- // Check Spindle Speed Focas1.ODBACT2 spindleSpeed = new Focas1.ODBACT2(); Focas1.cnc_acts2(machineTool.hFanucMonitor, 1, spindleSpeed); mRealSpeed.Value = (spindleSpeed.data[0] / 10000).ToString(); //-------------------------------------------------------------------------------------------------------------- // Get Drives Ready int ret3 = Focas1.pmc_rdpmcrng(machineTool.hFanucMonitor, 1, 0, 1, 1, 16, pmcDrivesOn); driveReady = GetBit(pmcDrivesOn.cdata[0], 7, true); mDrivesReady.Value = driveReady ? "Ready" : "Not Ready"; //-------------------------------------------------------------------------------------------------------------- // Get Messages Focas1.OPMSG3 opmsg = new Focas1.OPMSG3(); short msgSize = 5; Focas1.cnc_rdopmsg3(machineTool.hFanucMonitor, -1, ref msgSize, opmsg); // Op Message 1 if (opmsg.msg1.datano != 0 && opmsg.msg1.datano != -1) { mOpMsg1.Value = opmsg.msg1.data.ToString(); } else { mOpMsg1.Value = string.Empty; } // Op Message 2 if (opmsg.msg2.datano != 0 && opmsg.msg2.datano != -1) { mOpMsg2.Value = opmsg.msg2.data.ToString(); } else { mOpMsg2.Value = string.Empty; } // Op Message 3 if (opmsg.msg3.datano != 0 && opmsg.msg3.datano != -1) { mOpMsg3.Value = opmsg.msg3.data.ToString(); } else { mOpMsg3.Value = string.Empty; } // Op Message 4 if (opmsg.msg4.datano != 0 && opmsg.msg4.datano != -1) { mOpMsg4.Value = opmsg.msg4.data.ToString(); } else { mOpMsg4.Value = string.Empty; } //-------------------------------------------------------------------------------------------------------------- // Get Drives On ret3 = Focas1.pmc_rdpmcrng(machineTool.hFanucMonitor, 1, 0, 0, 0, 16, pmcDrivesOn); drivesOn = GetBit(pmcDrivesOn.cdata[0], 2); mDrivesOn.Value = drivesOn ? "Drives On" : "Drives Off"; //-------------------------------------------------------------------------------------------------------------- // If Drives are not on and we have a reason set already, figure out how long we have been in estop if (!drivesOn && reasonSet) { mDownTimeDuration.Value = dt.GetElapsedDownTime(ref totalElapsedDT); } // If the drives are not on and we do not have a reason set, show the reason popup box // And start our downtime counter. Also set reason to true. if (!drivesOn && !reasonSet) { machineTool.Invoke((MethodInvoker)delegate() { dt.Show(); }); startTime = dt.startDownTimeCounter(); reasonSet = true; } // If the drives are on (We have cleared all the errors), and we have a reason set (We just came out of estop) // So we will get the duration of the downtime, the reason for the downtime and record it. if (drivesOn && reasonSet) { duration = dt.GetElapsedDownTime(ref totalElapsedDT); endTime = dt.stopDownTimeCounter(); mDTReason.Value = dt.reason; // Log the Downtime here dtBuffer = true; BufferDataItems(); dtBuffer = false; reasonSet = false; } if (mDTReason.Value != string.Empty) { // Now that we are back in our normal loop, the reason is no longer needed // So now we set it to an empty string and set it to the reason for the last // Downtime period that we had. mDTLastReason.Value = dt.reason; mDTReason.Value = string.Empty; mDownTimeDuration.Value = string.Empty; mLastDownTimeDuration.Value = duration; } //--------------------------------------------------------------------------------------------------------------- // Get Feed Hold // Vac On / Off Focas1.IODBPMC0 vacSensors = new Focas1.IODBPMC0(); ret3 = Focas1.pmc_rdpmcrng(machineTool.hFanucMonitor, 5, 0, 46,46, 16, vacSensors); bool vac1 = GetBit(vacSensors.cdata[0], 1, false); bool vac2 = GetBit(vacSensors.cdata[0], 2, false); bool vac3 = GetBit(vacSensors.cdata[0], 3, false); bool vac4 = GetBit(vacSensors.cdata[0], 4, false); bool vac5 = GetBit(vacSensors.cdata[0], 5, false); bool vac6 = GetBit(vacSensors.cdata[0], 6, false); bool vac7 = GetBit(vacSensors.cdata[0], 7, false); bool vac8 = GetBit(vacSensors.cdata[0], 8, false); } else { mAvail.Value = "UNAVAILABLE"; } }
/* number is variable number to be read. * GetCounter(526);//cnc362 10.1.90.4 * GetCounter(511);//cnc422 10.1.90.5 * GetCounter(501);//cnc422 10.1.90.2 * */ decimal GetVariable(string ip, short variable) { short ret = -1; decimal value = -1; ushort fanucHandle = 0; try { ret = Focas1.cnc_allclibhndl3(ip, 8193, 6, out fanucHandle); if (ret == Focas1.EW_OK) { Console.WriteLine("We are connected!"); } else { // Console.WriteLine("There was an error connecting. Return value: " + _ret); throw new Exception("There was an error connecting. Return value: " + ret); } Focas1.ODBM macro = new Focas1.ODBM(); string strVal; ret = Focas1.cnc_rdmacro(fanucHandle, variable, 10, macro); if (ret == Focas1.EW_OK) { // mcr_val = 406000000 // dec_val = 6 // value = 406.000000 strVal = string.Format("{0:d9}", Math.Abs(macro.mcr_val)); if (0 < macro.dec_val) { strVal = strVal.Insert(9 - macro.dec_val, "."); } if (macro.mcr_val < 0) { strVal = "-" + strVal; } decimal decimalVal; decimalVal = Convert.ToDecimal(strVal); Console.WriteLine("String converted to decimal = {0} ", decimalVal); value = decimalVal; //partCounter = Convert.ToInt32(decimalVal); // partCounter2 = macro.mcr_val; } else { throw new Exception("There was an error reading the macro variable. Return value: " + ret); // Console.WriteLine("**********"); } } catch (Exception e) { Console.WriteLine("Exception in GetVariable => {0}", e); throw e; // will bubble up after finally } finally { if (fanucHandle != 0) { Focas1.cnc_freelibhndl(fanucHandle); Console.WriteLine("Handle has been freed"); } } return(value); }