CyberX8/CyberX8_Simulator/Devices/FestoSocketSimulator.cs

using MECF.Framework.Common.Net;
using MECF.Framework.Simulator.Core.Driver;
using System;
using System.Collections.Generic;

namespace CyberX8_Simulator.Devices
{
    public class FestoSocketSimulator : SocketDeviceSimulator
    {
        //Write Address   
        private const ushort FESTO_DO_START_ADDRESS = 0x9C43;//FestoDO起始地址(40003)

        //Read Address
        private const ushort FESTO_DI_START_ADDRESS = 0xB153;//FestoDI起始地址(45395)

        //Register Count
        private const int FESTO_REGISTER_COUNT = 100;
        private IByteTransform byteTransform = new BigEndianByteTransformBase();
        /// <summary>
        /// 数据(DO_address - data)
        /// </summary>
        private short[] _festoOutputDataDic = new short[FESTO_REGISTER_COUNT];

        /// <summary>
        /// 构造函数
        /// </summary>
        /// <param name="port"></param>
        public FestoSocketSimulator(int port) : base(port)
        {
            for(int i = 0; i < FESTO_REGISTER_COUNT; i++)
            {
                _festoOutputDataDic[i] = 0x00;
            }
        }
        /// <summary>
        /// 解析信息
        /// </summary>
        /// <param name="data"></param>
        protected override void ProcessUnsplitMessage(byte[] data)
        {
            short flag = byteTransform.TransInt16(data, 0);//事务标识符
            byte channel = data[6];//单元标识符
            byte command = data[7];//功能码
            if (command == 0x03)//读取
            {
                ushort startAddress = byteTransform.TransUInt16(data, 8);//起始寄存器地址
                short registerCount = byteTransform.TransInt16(data, 10);//寄存器数量

                byte[] bytes = new byte[2 * registerCount];//读取2*registerCount Byte数据
                if (startAddress >= FESTO_DI_START_ADDRESS)
                {
                    for (int i = 0; i < registerCount; i++)
                    {
                        Array.Copy(byteTransform.GetBytes(_festoOutputDataDic[i]), 0, bytes, i * 2, 2);
                    }
                    OnWriteMessage(CreateReadResponse(flag, channel, command, registerCount, bytes));
                }
                else
                {
                    OnWriteMessage(CreateError(flag, channel, command, 0x8A));
                }                
            }
            else if(command == 0x06)//写入
            {
                ushort startAddress = byteTransform.TransUInt16(data, 8);//起始寄存器地址
                short value = byteTransform.TransInt16(data, 10);//写入的值(2 Byte)

                if(startAddress >= FESTO_DO_START_ADDRESS)
                {
                    //modbus起始地址n为数据，n+1为诊断数据，取地址n下的数据
                    int index = (startAddress - FESTO_DO_START_ADDRESS) * 2;
                    _festoOutputDataDic[index] = value;
                    OnWriteMessage(CreateWriteResponse(flag, channel, command, startAddress, value));
                }
                else
                {
                    OnWriteMessage(CreateError(flag, channel, command, 0x8A));
                }                
            }
            else
            {
                OnWriteMessage(CreateError(flag, channel, command, 0x84));
            }
        }
        /// <summary>
        /// 读回复
        /// </summary>
        /// <param name="flag"></param>
        /// <param name="channel"></param>
        /// <param name="command"></param>
        /// <param name="registerCount"></param>
        /// <param name="values"></param>
        /// <returns></returns>
        private byte[] CreateReadResponse(short flag, byte channel, byte command, short registerCount, byte[] values)
        {
            
            byte[] bytes = new byte[6 + 3 + values.Length];
            Array.Copy(byteTransform.GetBytes(flag), 0, bytes, 0, 2);
            bytes[2] = 0x00;
            bytes[3] = 0x00;
            short dataLength = (short)(3 + values.Length);
            Array.Copy(byteTransform.GetBytes(dataLength), 0, bytes, 4, 2);
            bytes[6] = channel;
            bytes[7] = command;
            bytes[8] = (byte)(2 * registerCount);
            Array.Copy(values, 0, bytes, 9, values.Length);
            return bytes;
        }
        /// <summary>
        /// 写回复
        /// </summary>
        /// <param name="flag"></param>
        /// <param name="channel"></param>
        /// <param name="command"></param>
        /// <param name="startAddress"></param>
        /// <param name="value"></param>
        /// <returns></returns>
        private byte[] CreateWriteResponse(short flag, byte channel, byte command, ushort startAddress, short value)
        {
            byte[] bytes = new byte[12];
            Array.Copy(byteTransform.GetBytes(flag), 0, bytes, 0, 2);
            bytes[2] = 0x00;
            bytes[3] = 0x00;
            bytes[4] = 0x00;
            bytes[5] = 0x06;
            bytes[6] = channel;
            bytes[7] = command;
            byte[] addressByt = byteTransform.GetBytes(startAddress);
            Array.Copy(addressByt, 0, bytes, 8, 2);
            byte[] valueByt = byteTransform.GetBytes(value);
            Array.Copy(valueByt, 0, bytes, 10, 2);
            return bytes;
        }
        
        /// <summary>
        /// 错误回复
        /// </summary>
        /// <param name="flag"></param>
        /// <param name="channel"></param>
        /// <param name="command"></param>
        /// <param name="error"></param>
        /// <returns></returns>
        private byte[] CreateError(short flag, byte channel, byte command, byte error)
        {
            byte[] bytes = new byte[9];
            Array.Copy(byteTransform.GetBytes(flag), 0, bytes, 0, 2);
            bytes[2] = 0x00;
            bytes[3] = 0x00;
            bytes[4] = 0x00;
            bytes[5] = 0x03;
            bytes[6] = channel;
            bytes[7] = (byte)(command | 0x80);
            bytes[8] = error;
            return bytes;
        }

    }
}