private static List<FunctionBlockRow> GetMC5Rows(byte[] code, int codestart, List<S5Parameter> parameters, Step5BlocksFolder blkFld, S5FunctionBlock block) { List<FunctionBlockRow> retVal=new List<FunctionBlockRow>(); int codepos = codestart; retVal.Add(new S5FunctionBlockRow() {Command = "BLD", Parameter = "255", Parent = block}); //Command for first Network does not exist! //This needs to be removen when written back to S5D! while (codepos < code.Length) { byte mc = code[codepos]; // finde Befehle in der Symbol Tabelle int index = find_mc5_code(code, codepos); S5FunctionBlockRow newRow = new S5FunctionBlockRow(){Parent = block}; if (index >= 0) { newRow.MC5LIB_SYMTAB_Row = (object[])sym[index]; bool fb = false; newRow.Command = (string) ((object[]) sym[index])[operation]; string oper = (string) ((object[]) sym[index])[operand]; if (oper == "PAR") { int paridx = find_mc5_param(code, codepos, index); if (parameters != null && parameters.Count > paridx - 1) { newRow.Parameter = "=" + parameters[paridx - 1].Name; } else { newRow.Parameter = "$$error$$ -> invalid Parameter, idx:"+ (paridx - 1); } } else { if (oper != null) newRow.Parameter = oper; fb = IsCall(newRow); //false; /*if ((newRow.Command=="SPA" && newRow.Parameter=="FB") || (newRow.Command=="SPB" && newRow.Parameter=="FB") || (newRow.Command=="BA" && newRow.Parameter=="FX") || (newRow.Command=="BAB" && newRow.Parameter=="FX")) { fb = true; }*/ int par = find_mc5_param(code, codepos, index); switch ((string)((object[])sym[index])[printpar]) { case null: break; case "PrintNummer": if (!string.IsNullOrEmpty(newRow.Parameter)) newRow.Parameter += " "; Int16 wrt =(Int16)par; if (wrt >= 0 && newRow.Parameter == "KF ") newRow.Parameter += " +"; newRow.Parameter += wrt.ToString(); break; case "PrintKY": newRow.Parameter += BitConverter.GetBytes(par)[1].ToString() + "," + BitConverter.GetBytes(par)[0].ToString(); break; case "PrintChar": if (!string.IsNullOrEmpty(newRow.Parameter)) newRow.Parameter += " "; newRow.Parameter += ((char)(BitConverter.GetBytes((Int16)par)[0])).ToString() + ((char)(BitConverter.GetBytes((Int16)par)[1])); break; case "PrintHEX4": if (!string.IsNullOrEmpty(newRow.Parameter)) newRow.Parameter += " "; newRow.Parameter += par.ToString("X").PadLeft(4, '0'); break; case "PrintGleitpunkt": if (!string.IsNullOrEmpty(newRow.Parameter)) newRow.Parameter += " "; newRow.Parameter += "gleit"; break; case "PrintHEX8": if (!string.IsNullOrEmpty(newRow.Parameter)) newRow.Parameter += " "; newRow.Parameter += par.ToString("X").PadLeft(4, '0'); break; case "PrintMerkerBit": if (!string.IsNullOrEmpty(newRow.Parameter)) newRow.Parameter += " "; newRow.Parameter += (par & 0x00FF).ToString() + "." + (par >> 8).ToString(); break; case "PrintSMerkerBit": if (!string.IsNullOrEmpty(newRow.Parameter)) newRow.Parameter += " "; newRow.Parameter += (par & 0x0FFF).ToString() + "." + (par >> 12).ToString(); break; } } int _parlen = (int)((object[])sym[index])[parlen]; int _codelen = (int)((object[])sym[index])[codelen]; int btSize = (_codelen + _parlen) / 8; codepos += btSize; // Schleifenzähler if (fb) { //FB-Call index = find_mc5_code(code, codepos); if (index < 0 || (string)((object[])sym[index])[operation] != "SPA=") newRow.Command = "Error reading Jump after FB/FX Call!"; int spa = find_mc5_param(code, codepos, index); newRow.ExtParameter=new List<S5Parameter>(); //newRow.ExtParameter = new List<string>(); byte[] calledfb = blkFld.GetBlockInByte("S5_" + newRow.Parameter.Replace(" ", "")); if (calledfb!=null) { S5Parameter newPar = new S5Parameter(); newRow.ExtParameter.Add(newPar); string fbNM = System.Text.Encoding.GetEncoding("ISO-8859-1").GetString(calledfb, 12, 8); //newRow.ExtParameter.Add("Name :" + fbNM); newPar.Name = "Name :"; newPar.Value = fbNM; List<S5Parameter> par = GetParameters(calledfb); int j = 0; foreach (var s5Parameter in par) { newPar = new S5Parameter(); newRow.ExtParameter.Add(newPar); j++; string akOper = ""; int pos = codepos + j*2; switch (s5Parameter.S5ParameterType) { case S5ParameterType.A: case S5ParameterType.E: int ber = code[pos]; switch (s5Parameter.S5ParameterFormat) { case S5ParameterFormat.BI: switch (ber & 0xf0) { case 0x80: akOper += "M"; break; } akOper += code[pos + 1].ToString(); akOper += "." + (code[pos] & 0x0f).ToString(); break; case S5ParameterFormat.BY: switch (ber) { case 0x0a: akOper += "MB"; break; case 0x2a: akOper += "DR"; break; case 0x22: akOper += "DL"; break; default: akOper += ""; break; } akOper += code[pos + 1].ToString(); break; case S5ParameterFormat.W: switch (ber) { case 0x12: akOper += "MW"; break; case 0x32: akOper += "DW"; break; } akOper += code[pos + 1].ToString(); break; case S5ParameterFormat.D: break; } break; case S5ParameterType.D: int wrt = code[pos]*0x100 + code[pos + 1]; akOper += s5Parameter.S5ParameterFormat.ToString() + " "; switch (s5Parameter.S5ParameterFormat) { case S5ParameterFormat.KF: if (((Int16)wrt)>0) akOper += "+"; akOper += ((Int16)wrt).ToString(); break; case S5ParameterFormat.KT: //code[pos + 1] // Bit 4-7 0-3 4-7 0-3 //Format: Zeitbasis, 100er, 10er, 1er akOper += wrt.ToString().PadLeft(3, '0') + ".0"; break; case S5ParameterFormat.KC: akOper += (char)code[pos] + (char)code[pos + 1]; break; case S5ParameterFormat.KM: akOper += libnodave.dec2bin(code[pos]) + " "; akOper += libnodave.dec2bin(code[pos + 1]); break; case S5ParameterFormat.KY: akOper += code[pos].ToString() + "," + code[pos + 1].ToString(); break; default: akOper += ((Int16)wrt).ToString("X").PadLeft(4, '0'); break; } break; case S5ParameterType.B: int bst = code[pos]; switch (bst) { case 0x20: akOper += "DB"; break; } akOper += code[pos + 1].ToString(); break; case S5ParameterType.T: //int abst = code[pos]; akOper += "T " + code[pos + 1].ToString(); break; case S5ParameterType.Z: akOper += "Z " + code[pos + 1].ToString(); break; } newPar.Name = s5Parameter.Name; newPar.Value = akOper; //newRow.ExtParameter.Add(s5Parameter.Name.PadRight(5, ' ') + ": " + akOper); } } else for (int j = 1; j < spa; j++) { int myPar = (code[codepos + j*2] << 8) | code[codepos + j*2 + 1]; //newRow.ExtParameter.Add(myPar.ToString()); S5Parameter newPar = new S5Parameter(); newRow.ExtParameter.Add(newPar); newPar.Name = myPar.ToString(); } btSize += spa * 2; codepos += spa * 2; fb = false; } byte[] MC5 = new byte[btSize]; Array.Copy(code,codepos - btSize, MC5, 0, btSize); newRow.MC5 = MC5; } else { newRow.Command = "Error converting command!"; codepos += 2; //throw new Exception("Code nicht in Symtab!"); } retVal.Add(newRow); } #region Build the Jumpsmarks.... int JumpCount = 1; int akBytePos = 0; Dictionary<int, S5FunctionBlockRow> ByteAdressNumerPLCFunctionBlocks = new Dictionary<int, S5FunctionBlockRow>(); foreach (S5FunctionBlockRow tmp in retVal) { if (tmp.ByteSize > 0) { ByteAdressNumerPLCFunctionBlocks.Add(akBytePos, tmp); akBytePos += tmp.ByteSize; } } akBytePos = 0; foreach (S5FunctionBlockRow tmp in retVal) { if (tmp.Command == "SPA=" || tmp.Command == "SPB=" || tmp.Command == "SPZ=" || tmp.Command == "SPN=" || tmp.Command == "SPP=" || tmp.Command == "SPM=" || tmp.Command == "SPO=") { int jmpBytePos = 0; byte[] backup = tmp.MC5; tmp.Command = tmp.Command.Substring(0, tmp.Command.Length - 1); tmp.JumpWidth = (SByte)Convert.ToInt32(tmp.Parameter); jmpBytePos = akBytePos + (tmp.JumpWidth * 2); if (ByteAdressNumerPLCFunctionBlocks.ContainsKey(jmpBytePos)) { var target = ByteAdressNumerPLCFunctionBlocks[jmpBytePos]; if (target.Label.Trim() == "") { target.Label = "M" + JumpCount.ToString().PadLeft(3, '0'); JumpCount++; } //Backup the MC7 Code, because the MC7 Code is always deleted when the command or parameter changes! tmp.Parameter = "=" + target.Label; tmp.MC5 = backup; } else { tmp.Parameter = "Error! JumpWidth :" + tmp.JumpWidth; tmp.MC5 = backup; } } akBytePos += tmp.ByteSize; } #endregion return retVal; }
private static bool IsCall(S5FunctionBlockRow newRow) { if ((newRow.Command == "SPA" && newRow.Parameter.Substring(0,2) == "FB") || (newRow.Command == "SPB" && newRow.Parameter.Substring(0, 2) == "FB") || (newRow.Command == "BA" && newRow.Parameter.Substring(0, 2) == "FX") || (newRow.Command == "BAB" && newRow.Parameter.Substring(0, 2) == "FX")) { return true; } return false; }