MewtocolNet/MewtocolNet/ProgramParsing/PlcBinaryProgram.cs

using System.Text;
using System;
using System.IO;
using System.Collections.Generic;
using System.Linq;
using System.Globalization;
using MewtocolNet.AutoGeneratedData;

namespace MewtocolNet.ProgramParsing {

    public class PlcBinaryProgram {

        static readonly Dictionary<ushort, string> stepCommands = new Dictionary<ushort, string> {
            { 0x00FF, "SUB 0" },

            { 0xB0FF, "DF" },
            { 0xFAF8, "ED" },
            { 0xFDF8, "RET" }, //return
            { 0xF6F8, "CALL" },
            { 0xEEF8, "SET" },

            { 0x21CC, "OT R501" },
            //{ 0x21AC, "ST R501" },
            //{ 0xF7FF, "ST R9010" }, 

        };

        static readonly Dictionary<string, string> sysRegisters = new Dictionary<string, string> {
            { "R9009", "sys_bIsCarry" },
            { "R900A", "sys_bIsGreaterThan" },
            { "R900B", "sys_bIsEqual" },
            { "R900C", "sys_bIsLessThan" },
            { "R900D", "sys_bIsAuxiliaryTimerElapsed" },

            { "R9010", "sys_bTrue" },
            { "R9011", "sys_bFalse" },
            { "R9012", "sys_bScanPulse" },
            { "R9013", "sys_bIsFirstScan" },
            { "R9014", "sys_bIsNotFirstScan" },
            { "R9015", "sys_bIsFirstScanOfSfcStep" },
            { "R9018", "sys_bPulse10ms" },
            { "R9019", "sys_bPulse20ms" },
            { "R901A", "sys_bPulse100ms" },
            { "R901B", "sys_bPulse200ms" },
            { "R901C", "sys_bPulse1s" },
            { "R901D", "sys_bPulse2s" },
            { "R901E", "sys_bPulse1min" },
        };

        // ST R50_1 21 AC => WR system area start was set to 50
        // ST R57_1 91 AC => WR system area start was set to 57
        // ST R901_3 F7 FF 53 A9
        // ST R901_C F7 FF 5C A9
        // AN/ R900_B F7 FF 4B 49

        const int STEP_BYTE_LEN = 2;

        const int PROG_AUTHOR_INDEX = 57;
        const int PROG_AUTHOR_MAX_CHARS = 12;

        const int PROG_DESCRIPTION_INDEX = 17;
        const int PROG_DESCRIPTION_MAX_CHARS = 40;

        const int PROG_SIZE_START = 1139;
        const int PROG_DATA_START = 1179;

        public List<byte[]> rawSteps;

        public string Author { get; internal set; }  

        public string Description { get; internal set; }

        public static PlcBinaryProgram ParseFromFile (string path) {

            var retInstance = new PlcBinaryProgram();

            var rawBytes = File.ReadAllBytes(path);

            if (rawBytes.Length < 2 || (rawBytes[0] != 0x46 && rawBytes[1] != 0x50))
                throw new NotSupportedException("The loaded file was no FP file");

            var rawString = Encoding.ASCII.GetString(rawBytes);

            //get author and description
            var progAuthor = Encoding.ASCII.GetString(rawBytes, PROG_AUTHOR_INDEX, PROG_AUTHOR_MAX_CHARS).Replace("\0", "");
            var progDescription = Encoding.ASCII.GetString(rawBytes, PROG_DESCRIPTION_INDEX, PROG_DESCRIPTION_MAX_CHARS).Replace("\0", "");
            var progSizeSteps = BitConverter.ToInt32(rawBytes, PROG_SIZE_START);

            //improve performance later
            var steps = new List<byte[]>();

            for (int i = 0; i < progSizeSteps; i++) {

                //00-FF F8 => 0-255 default function
                //FF F8 => extended function, look for next step

                var step = rawBytes.Skip(PROG_DATA_START + (i * STEP_BYTE_LEN)).Take(STEP_BYTE_LEN).ToArray();

                steps.Add(step);

            }

            retInstance.rawSteps = steps;

            return retInstance;

        }

        public void AnalyzeProgram () {

            for (int i = 0; i < rawSteps.Count; i++) {

                var step = rawSteps[i];

                var stepAscii = Encoding.ASCII.GetString(step);
                var stepBytesString = string.Join(" ", step.Select(x => x.ToString("X2")));

                Console.Write($"{i,3} => {stepBytesString} ");

                var stepKey = BitConverter.ToUInt16(step.Reverse().ToArray(), 0);
                byte[] nextStep = null;

                if(i + 1 < rawSteps.Count - 1)
                    nextStep = rawSteps[i + 1];

                if (stepCommands.ContainsKey(stepKey)) {

                    Console.Write($"{stepCommands[stepKey]}");

                } else if (nextStep != null && step[0] == 0xF7 && step[1] == 0xFF && nextStep[1] == 0xA9) {

                    //ST step
                    
                    var area = nextStep[0].ToString("X2").Substring(0, 1);
                    var specialArea = nextStep[0].ToString("X2").Substring(1, 1);

                    var stepID = 896 + int.Parse(area, NumberStyles.HexNumber);
                    var stCondition = $"R{stepID}{specialArea}";

                    Console.Write($"ST {GetSysRegisterName(stCondition)}");

                } else if (nextStep != null && step[0] == 0xF7 && step[1] == 0xFF && nextStep[1] == 0x49) {

                    //AN/ step

                    var area = nextStep[0].ToString("X2").Substring(0, 1);
                    var specialArea = nextStep[0].ToString("X2").Substring(1, 1);

                    var stepID = 896 + int.Parse(area, NumberStyles.HexNumber);
                    var stCondition = $"R{stepID}{specialArea}";

                    Console.Write($"AN/ {GetSysRegisterName(stCondition)}");

                } else if (step[1] == 0xF8) {

                    int functionID = 0;

                    if (step[0] == 0xFF) {
                        //custom function that goes over FF, the F instruction number is calced by
                        //the next step first byte plus 190
                        functionID = nextStep[0] + 190;
                    } else {
                        functionID = step[0];
                    }

                    string funcName = GetFunctionName($"F{functionID}");
                    Console.Write(funcName);

                    //get the params and outs of the function


                }

                //if (stepBytesString.StartsWith("F")) {
                //    Console.Write(" STEP COMMAND");
                //}

                Console.WriteLine();

            }


            Console.WriteLine();

        }

        private string GetFunctionName (string funcName) {

            var found = FPFunction.functions.FirstOrDefault(x => x.Key.StartsWith(funcName));

            if (!found.Equals(default(KeyValuePair<string, FPFunction>))) {

                var sb = new StringBuilder();

                var splt = found.Key.Split('_');

                sb.Append($"{splt[0]} (*{splt[1]}*)");

                if(found.Value.ParametersIn.Count > 0) {

                    sb.Append($" IN: {found.Value.ParametersIn.Count}");

                }

                if (found.Value.ParametersOut.Count > 0) {

                    sb.Append($" OUT: {found.Value.ParametersOut.Count}");

                }

                return sb.ToString();

            }

            return funcName;

        } 

        private string GetSysRegisterName (string fpAddress) {

            return sysRegisters.ContainsKey(fpAddress) ? $"{fpAddress} ({sysRegisters[fpAddress]})" : fpAddress;

        }

    }

}