123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555 |
- using System;
- using System.Collections.Generic;
- using System.Linq;
- using System.Net.Sockets;
- using System.Text;
- using System.Threading.Tasks;
- using Aitex.Core.RT.Log;
- using MECF.Framework.RT.Core.IoProviders.Common;
- using MECF.Framework.RT.Core.IoProviders.Common.Net.NetworkBase;
- using MECF.Framework.RT.Core.IoProviders.Common.Net.StateOne;
- using MECF.Framework.RT.Core.IoProviders.Common.Transfer;
- namespace MECF.Framework.RT.Core.IoProviders.Melsec
- {
- /// <summary>
- /// 三菱MC协议的虚拟服务器,支持M,X,Y,D,W的数据池读写操作,使用二进制进行读写操作
- /// </summary>
- public class MelsecMcServer : NetworkDataServerBase
- {
- #region Constructor
- /// <summary>
- /// 实例化一个mc协议的服务器
- /// </summary>
- public MelsecMcServer()
- {
- // 共计使用了五个数据池
- xBuffer = new SoftBuffer(DataPoolLength);
- yBuffer = new SoftBuffer(DataPoolLength);
- mBuffer = new SoftBuffer(DataPoolLength);
- dBuffer = new SoftBuffer(DataPoolLength * 2);
- wBuffer = new SoftBuffer(DataPoolLength * 2);
- WordLength = 1;
- ByteTransform = new RegularByteTransform();
- }
- #endregion
- #region NetworkDataServerBase Override
- /// <summary>
- /// 读取自定义的寄存器的值。按照字为单位
- /// </summary>
- /// <param name="address">起始地址,示例:"D100","M100"</param>
- /// <param name="length">数据长度</param>
- /// <exception cref="IndexOutOfRangeException"></exception>
- /// <returns>byte数组值</returns>
- public override OperateResult<byte[]> Read(string address, ushort length)
- {
- OperateResult<MelsecMcDataType, int> analysis = MelsecHelper.McAnalysisAddress(address);
- if (!analysis.IsSuccess) return OperateResult.CreateFailedResult<byte[]>(analysis);
- if (analysis.Content1.DataCode == MelsecMcDataType.M.DataCode)
- {
- bool[] buffer = mBuffer.GetBytes(analysis.Content2, length * 16).Select(m => m != 0x00).ToArray();
- return OperateResult.CreateSuccessResult(SoftBasic.BoolArrayToByte(buffer));
- }
- else if (analysis.Content1.DataCode == MelsecMcDataType.X.DataCode)
- {
- bool[] buffer = xBuffer.GetBytes(analysis.Content2, length * 16).Select(m => m != 0x00).ToArray();
- return OperateResult.CreateSuccessResult(SoftBasic.BoolArrayToByte(buffer));
- }
- else if (analysis.Content1.DataCode == MelsecMcDataType.Y.DataCode)
- {
- bool[] buffer = yBuffer.GetBytes(analysis.Content2, length * 16).Select(m => m != 0x00).ToArray();
- return OperateResult.CreateSuccessResult(SoftBasic.BoolArrayToByte(buffer));
- }
- else if (analysis.Content1.DataCode == MelsecMcDataType.D.DataCode)
- {
- return OperateResult.CreateSuccessResult(dBuffer.GetBytes(analysis.Content2 * 2, length * 2));
- }
- else if (analysis.Content1.DataCode == MelsecMcDataType.W.DataCode)
- {
- return OperateResult.CreateSuccessResult(wBuffer.GetBytes(analysis.Content2 * 2, length * 2));
- }
- else
- {
- return new OperateResult<byte[]>(StringResources.Language.NotSupportedDataType);
- }
- }
- /// <summary>
- /// 写入自定义的数据到数据内存中去
- /// </summary>
- /// <param name="address">地址</param>
- /// <param name="value">数据值</param>
- /// <returns>是否写入成功的结果对象</returns>
- public override OperateResult Write(string address, byte[] value)
- {
- OperateResult<MelsecMcDataType, int> analysis = MelsecHelper.McAnalysisAddress(address);
- if (!analysis.IsSuccess) return OperateResult.CreateFailedResult<byte[]>(analysis);
- if (analysis.Content1.DataCode == MelsecMcDataType.M.DataCode)
- {
- byte[] buffer = SoftBasic.ByteToBoolArray(value).Select(m => m ? (byte)1 : (byte)0).ToArray();
- mBuffer.SetBytes(buffer, analysis.Content2);
- return OperateResult.CreateSuccessResult();
- }
- else if (analysis.Content1.DataCode == MelsecMcDataType.X.DataCode)
- {
- byte[] buffer = SoftBasic.ByteToBoolArray(value).Select(m => m ? (byte)1 : (byte)0).ToArray();
- xBuffer.SetBytes(buffer, analysis.Content2);
- return OperateResult.CreateSuccessResult();
- }
- else if (analysis.Content1.DataCode == MelsecMcDataType.Y.DataCode)
- {
- byte[] buffer = SoftBasic.ByteToBoolArray(value).Select(m => m ? (byte)1 : (byte)0).ToArray();
- yBuffer.SetBytes(buffer, analysis.Content2);
- return OperateResult.CreateSuccessResult();
- }
- else if (analysis.Content1.DataCode == MelsecMcDataType.D.DataCode)
- {
- dBuffer.SetBytes(value, analysis.Content2 * 2);
- return OperateResult.CreateSuccessResult();
- }
- else if (analysis.Content1.DataCode == MelsecMcDataType.W.DataCode)
- {
- wBuffer.SetBytes(value, analysis.Content2 * 2);
- return OperateResult.CreateSuccessResult();
- }
- else
- {
- return new OperateResult<byte[]>(StringResources.Language.NotSupportedDataType);
- }
- }
- #endregion
- #region Bool Read Write Operate
- /// <summary>
- /// 读取指定地址的bool数据对象
- /// </summary>
- /// <param name="address">西门子的地址信息</param>
- /// <returns>带有成功标志的结果对象</returns>
- public OperateResult<bool> ReadBool(string address)
- {
- OperateResult<bool[]> read = ReadBool(address, 1);
- if (!read.IsSuccess) return OperateResult.CreateFailedResult<bool>(read);
- return OperateResult.CreateSuccessResult(read.Content[0]);
- }
- /// <summary>
- /// 读取指定地址的bool数据对象
- /// </summary>
- /// <param name="address">三菱的地址信息</param>
- /// <param name="length">数组的长度</param>
- /// <returns>带有成功标志的结果对象</returns>
- public OperateResult<bool[]> ReadBool(string address, ushort length)
- {
- OperateResult<MelsecMcDataType, int> analysis = MelsecHelper.McAnalysisAddress(address);
- if (!analysis.IsSuccess) return OperateResult.CreateFailedResult<bool[]>(analysis);
- if (analysis.Content1.DataType == 0) return new OperateResult<bool[]>(StringResources.Language.MelsecCurrentTypeNotSupportedWordOperate);
- if (analysis.Content1.DataCode == MelsecMcDataType.M.DataCode)
- {
- return OperateResult.CreateSuccessResult(mBuffer.GetBytes(analysis.Content2, length).Select(m => m != 0x00).ToArray());
- }
- else if (analysis.Content1.DataCode == MelsecMcDataType.X.DataCode)
- {
- return OperateResult.CreateSuccessResult(xBuffer.GetBytes(analysis.Content2, length).Select(m => m != 0x00).ToArray());
- }
- else if (analysis.Content1.DataCode == MelsecMcDataType.Y.DataCode)
- {
- return OperateResult.CreateSuccessResult(yBuffer.GetBytes(analysis.Content2, length).Select(m => m != 0x00).ToArray());
- }
- else if (analysis.Content1.DataCode == MelsecMcDataType.B.DataCode)
- {
- return OperateResult.CreateSuccessResult(yBuffer.GetBytes(analysis.Content2, length).Select(m => m != 0x00).ToArray());
- }
- else
- {
- return new OperateResult<bool[]>(StringResources.Language.NotSupportedDataType);
- }
- }
- /// <summary>
- /// 往指定的地址里写入bool数据对象
- /// </summary>
- /// <param name="address">三菱的地址信息</param>
- /// <param name="value">值</param>
- /// <returns>是否成功的结果</returns>
- public OperateResult Write(string address, bool value)
- {
- return Write(address, new bool[] { value });
- }
- /// <summary>
- /// 往指定的地址里写入bool数组对象
- /// </summary>
- /// <param name="address">三菱的地址信息</param>
- /// <param name="value">值</param>
- /// <returns>是否成功的结果</returns>
- public OperateResult Write(string address, bool[] value)
- {
- OperateResult<MelsecMcDataType, int> analysis = MelsecHelper.McAnalysisAddress(address);
- if (!analysis.IsSuccess) return OperateResult.CreateFailedResult<bool[]>(analysis);
- if (analysis.Content1.DataType == 0) return new OperateResult<bool[]>(StringResources.Language.MelsecCurrentTypeNotSupportedWordOperate);
- if (analysis.Content1.DataCode == MelsecMcDataType.M.DataCode)
- {
- mBuffer.SetBytes(value.Select(m => m ? (byte)1 : (byte)0).ToArray(), analysis.Content2);
- return OperateResult.CreateSuccessResult();
- }
- else if (analysis.Content1.DataCode == MelsecMcDataType.X.DataCode)
- {
- xBuffer.SetBytes(value.Select(m => m ? (byte)1 : (byte)0).ToArray(), analysis.Content2);
- return OperateResult.CreateSuccessResult();
- }
- else if (analysis.Content1.DataCode == MelsecMcDataType.Y.DataCode)
- {
- yBuffer.SetBytes(value.Select(m => m ? (byte)1 : (byte)0).ToArray(), analysis.Content2);
- return OperateResult.CreateSuccessResult();
- }
- else if (analysis.Content1.DataCode == MelsecMcDataType.B.DataCode)
- {
- yBuffer.SetBytes(value.Select(m => m ? (byte)1 : (byte)0).ToArray(), analysis.Content2);
- return OperateResult.CreateSuccessResult();
- }
- else
- {
- return new OperateResult<bool[]>(StringResources.Language.NotSupportedDataType);
- }
- }
- #endregion
- #region NetServer Override
- /// <summary>
- /// 当客户端登录后,进行Ip信息的过滤,然后触发本方法,也就是说之后的客户端需要
- /// </summary>
- /// <param name="socket">网络套接字</param>
- /// <param name="endPoint">终端节点</param>
- protected override void ThreadPoolLoginAfterClientCheck(Socket socket, System.Net.IPEndPoint endPoint)
- {
- // 开始接收数据信息
- AppSession appSession = new AppSession();
- appSession.IpEndPoint = endPoint;
- appSession.WorkSocket = socket;
- try
- {
- socket.BeginReceive(new byte[0], 0, 0, SocketFlags.None, new AsyncCallback(SocketAsyncCallBack), appSession);
- AddClient(appSession);
- }
- catch
- {
- socket.Close();
- LOG.Write(ToString()+string.Format(StringResources.Language.ClientOfflineInfo, endPoint));
- }
- }
- private void SocketAsyncCallBack(IAsyncResult ar)
- {
- if (ar.AsyncState is AppSession session)
- {
- try
- {
- int receiveCount = session.WorkSocket.EndReceive(ar);
- MelsecQnA3EBinaryMessage mcMessage = new MelsecQnA3EBinaryMessage();
- OperateResult<byte[]> read1 = ReceiveByMessage(session.WorkSocket, 5000, mcMessage);
- if (!read1.IsSuccess)
- {
- LOG.Write(ToString()+string.Format(StringResources.Language.ClientOfflineInfo+session.IpEndPoint));
- RemoveClient(session);
- return;
- };
- byte[] back = ReadFromMcCore(read1.Content);
- if (back != null)
- {
- session.WorkSocket.Send(back);
- }
- else
- {
- session.WorkSocket.Close();
- RemoveClient(session);
- return;
- }
- RaiseDataReceived(read1.Content);
- session.WorkSocket.BeginReceive(new byte[0], 0, 0, SocketFlags.None, new AsyncCallback(SocketAsyncCallBack), session);
- }
- catch
- {
- // 关闭连接,记录日志
- session.WorkSocket?.Close();
- LOG.Write(ToString()+ string.Format(StringResources.Language.ClientOfflineInfo+session.IpEndPoint));
- RemoveClient(session);
- return;
- }
- }
- }
- /// <summary>
- /// 当收到mc协议的报文的时候应该触发的方法,允许继承重写,来实现自定义的返回,或是数据监听。
- /// </summary>
- /// <param name="mcCore">mc报文</param>
- /// <returns>返回的报文信息</returns>
- protected virtual byte[] ReadFromMcCore(byte[] mcCore)
- {
- if (mcCore[11] == 0x01 && mcCore[12] == 0x04)
- {
- // 读数据
- return PackCommand(ReadByCommand(SoftBasic.BytesArrayRemoveBegin(mcCore, 11)));
- }
- else if (mcCore[11] == 0x01 && mcCore[12] == 0x14)
- {
- // 写数据
- return PackCommand(WriteByMessage(SoftBasic.BytesArrayRemoveBegin(mcCore, 11)));
- }
- else
- {
- return null;
- }
- }
- private byte[] PackCommand(byte[] data)
- {
- byte[] back = new byte[11 + data.Length];
- SoftBasic.HexStringToBytes("D0 00 00 FF FF 03 00 00 00 00 00").CopyTo(back, 0);
- if (data.Length > 0) data.CopyTo(back, 11);
- BitConverter.GetBytes((short)(data.Length + 2)).CopyTo(back, 7);
- return back;
- }
- private byte[] ReadByCommand(byte[] command)
- {
- if (command[2] == 0x01)
- {
- // 位读取
- ushort length = ByteTransform.TransUInt16(command, 8);
- int startIndex = (command[6] * 65536 + command[5] * 256 + command[4]);
- if (command[7] == MelsecMcDataType.M.DataCode)
- {
- byte[] buffer = mBuffer.GetBytes(startIndex, length);
- return MelsecHelper.TransBoolArrayToByteData(buffer);
- }
- else if (command[7] == MelsecMcDataType.X.DataCode)
- {
- byte[] buffer = xBuffer.GetBytes(startIndex, length);
- return MelsecHelper.TransBoolArrayToByteData(buffer);
- }
- else if (command[7] == MelsecMcDataType.Y.DataCode)
- {
- byte[] buffer = yBuffer.GetBytes(startIndex, length);
- return MelsecHelper.TransBoolArrayToByteData(buffer);
- }
- else if (command[7] == MelsecMcDataType.B.DataCode)
- {
- byte[] buffer = yBuffer.GetBytes(startIndex, length);
- return MelsecHelper.TransBoolArrayToByteData(buffer);
- }
- else
- {
- throw new Exception(StringResources.Language.NotSupportedDataType);
- }
- }
- else
- {
- // 字读取
- ushort length = ByteTransform.TransUInt16(command, 8);
- int startIndex = (command[6] * 65536 + command[5] * 256 + command[4]);
- if (command[7] == MelsecMcDataType.M.DataCode)
- {
- bool[] buffer = mBuffer.GetBytes(startIndex, length * 16).Select(m => m != 0x00).ToArray();
- return SoftBasic.BoolArrayToByte(buffer);
- }
- else if (command[7] == MelsecMcDataType.X.DataCode)
- {
- bool[] buffer = xBuffer.GetBytes(startIndex, length * 16).Select(m => m != 0x00).ToArray();
- return SoftBasic.BoolArrayToByte(buffer);
- }
- else if (command[7] == MelsecMcDataType.Y.DataCode)
- {
- bool[] buffer = yBuffer.GetBytes(startIndex, length * 16).Select(m => m != 0x00).ToArray();
- return SoftBasic.BoolArrayToByte(buffer);
- }
- else if (command[7] == MelsecMcDataType.D.DataCode)
- {
- bool[] buffer = yBuffer.GetBytes(startIndex, length * 16).Select(m => m != 0x00).ToArray();
- return SoftBasic.BoolArrayToByte(buffer);
- }
- else if (command[7] == MelsecMcDataType.D.DataCode)
- {
- return dBuffer.GetBytes(startIndex * 2, length * 2);
- }
- else if (command[7] == MelsecMcDataType.W.DataCode)
- {
- return wBuffer.GetBytes(startIndex * 2, length * 2);
- }
- else
- {
- throw new Exception(StringResources.Language.NotSupportedDataType);
- }
- }
- }
- private byte[] WriteByMessage(byte[] command)
- {
- if (command[2] == 0x01)
- {
- // 位写入
- ushort length = ByteTransform.TransUInt16(command, 8);
- int startIndex = (command[6] * 65536 + command[5] * 256 + command[4]);
- if (command[7] == MelsecMcDataType.M.DataCode)
- {
- byte[] buffer = MelsecMcNet.ExtractActualData(SoftBasic.BytesArrayRemoveBegin(command, 10), true).Content;
- mBuffer.SetBytes(buffer.Take(length).ToArray(), startIndex);
- return new byte[0];
- }
- else if (command[7] == MelsecMcDataType.X.DataCode)
- {
- byte[] buffer = MelsecMcNet.ExtractActualData(SoftBasic.BytesArrayRemoveBegin(command, 10), true).Content;
- xBuffer.SetBytes(buffer.Take(length).ToArray(), startIndex);
- return new byte[0];
- }
- else if (command[7] == MelsecMcDataType.Y.DataCode)
- {
- byte[] buffer = MelsecMcNet.ExtractActualData(SoftBasic.BytesArrayRemoveBegin(command, 10), true).Content;
- yBuffer.SetBytes(buffer.Take(length).ToArray(), startIndex);
- return new byte[0];
- }
- else if (command[7] == MelsecMcDataType.B.DataCode)
- {
- byte[] buffer = MelsecMcNet.ExtractActualData(SoftBasic.BytesArrayRemoveBegin(command, 10), true).Content;
- yBuffer.SetBytes(buffer.Take(length).ToArray(), startIndex);
- return new byte[0];
- }
- else
- {
- throw new Exception(StringResources.Language.NotSupportedDataType);
- }
- }
- else
- {
- // 字写入
- ushort length = ByteTransform.TransUInt16(command, 8);
- int startIndex = (command[6] * 65536 + command[5] * 256 + command[4]);
- if (command[7] == MelsecMcDataType.M.DataCode)
- {
- byte[] buffer = SoftBasic.ByteToBoolArray(SoftBasic.BytesArrayRemoveBegin(command, 10)).Select(m => m ? (byte)1 : (byte)0).ToArray();
- mBuffer.SetBytes(buffer, startIndex);
- return new byte[0];
- }
- else if (command[7] == MelsecMcDataType.X.DataCode)
- {
- byte[] buffer = SoftBasic.ByteToBoolArray(SoftBasic.BytesArrayRemoveBegin(command, 10)).Select(m => m ? (byte)1 : (byte)0).ToArray();
- xBuffer.SetBytes(buffer, startIndex);
- return new byte[0];
- }
- else if (command[7] == MelsecMcDataType.Y.DataCode)
- {
- byte[] buffer = SoftBasic.ByteToBoolArray(SoftBasic.BytesArrayRemoveBegin(command, 10)).Select(m => m ? (byte)1 : (byte)0).ToArray();
- yBuffer.SetBytes(buffer, startIndex);
- return new byte[0];
- }
- else if (command[7] == MelsecMcDataType.B.DataCode)
- {
- byte[] buffer = SoftBasic.ByteToBoolArray(SoftBasic.BytesArrayRemoveBegin(command, 10)).Select(m => m ? (byte)1 : (byte)0).ToArray();
- yBuffer.SetBytes(buffer, startIndex);
- return new byte[0];
- }
- else if (command[7] == MelsecMcDataType.D.DataCode)
- {
- dBuffer.SetBytes(SoftBasic.BytesArrayRemoveBegin(command, 10), startIndex * 2);
- return new byte[0];
- }
- else if (command[7] == MelsecMcDataType.W.DataCode)
- {
- wBuffer.SetBytes(SoftBasic.BytesArrayRemoveBegin(command, 10), startIndex * 2);
- return new byte[0];
- }
- else
- {
- throw new Exception(StringResources.Language.NotSupportedDataType);
- }
- }
- }
- #endregion
- #region Data Save Load Override
- /// <summary>
- /// 从字节数据加载数据信息
- /// </summary>
- /// <param name="content">字节数据</param>
- protected override void LoadFromBytes(byte[] content)
- {
- if (content.Length < DataPoolLength * 7) throw new Exception("File is not correct");
- mBuffer.SetBytes(content, 0, 0, DataPoolLength);
- xBuffer.SetBytes(content, DataPoolLength, 0, DataPoolLength);
- yBuffer.SetBytes(content, DataPoolLength * 2, 0, DataPoolLength);
- dBuffer.SetBytes(content, DataPoolLength * 3, 0, DataPoolLength);
- wBuffer.SetBytes(content, DataPoolLength * 5, 0, DataPoolLength);
- }
- /// <summary>
- /// 将数据信息存储到字节数组去
- /// </summary>
- /// <returns>所有的内容</returns>
- protected override byte[] SaveToBytes()
- {
- byte[] buffer = new byte[DataPoolLength * 7];
- Array.Copy(mBuffer.GetBytes(), 0, buffer, 0, DataPoolLength);
- Array.Copy(xBuffer.GetBytes(), 0, buffer, DataPoolLength, DataPoolLength);
- Array.Copy(yBuffer.GetBytes(), 0, buffer, DataPoolLength * 2, DataPoolLength);
- Array.Copy(dBuffer.GetBytes(), 0, buffer, DataPoolLength * 3, DataPoolLength);
- Array.Copy(wBuffer.GetBytes(), 0, buffer, DataPoolLength * 5, DataPoolLength);
- return buffer;
- }
- #endregion
- #region Private Member
- private SoftBuffer xBuffer; // x寄存器的数据池
- private SoftBuffer yBuffer; // y寄存器的数据池
- private SoftBuffer mBuffer; // m寄存器的数据池
- private SoftBuffer dBuffer; // d寄存器的数据池
- private SoftBuffer wBuffer; // w寄存器的数据池
- private const int DataPoolLength = 200000; // 数据的长度
- #endregion
- #region Object Override
- /// <summary>
- /// 返回表示当前对象的字符串
- /// </summary>
- /// <returns>字符串信息</returns>
- public override string ToString()
- {
- return $"MelsecMcServer[{Port}]";
- }
- #endregion
- }
- }
|