Common.cs
8.5 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
using System;
using System.Collections.Generic;
using System.IO;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
namespace Agv
{
public class Common
{
//包开始字节
public static byte[] headPack = new byte[] { 0xAB, 0xBA };
public static int headSize = 6;//包头识别符2+包头长度4
/// <summary>
/// 节点信息解析方式:默认解析单个
/// </summary>
public static bool EnDecodeSingleNode = true;
public static bool CheckHeadChar(byte[] head, out int starIdx)
{
starIdx = -1;
for (int i = 0; i < head.Length - headPack.Length+1; i++)
{
int j = 0;
for (j = 0; j < headPack.Length; j++)
{
if (!head[i + j].Equals(headPack[j]))
break;
}
if (j == headPack.Length)
{
starIdx = i;
return true;
}
}
return false;
}
public static string HexBuff(byte[] buff)
{
string s = "";
if (buff == null) return s;
for (int i = 0; i < buff.Length; i++)
s += buff[i].ToString("X2") + " ";
return s;
}
public static string HexBuffWithoutSpace(byte[] buff)
{
string s = "";
if (buff == null) return s;
for (int i = 0; i < buff.Length; i++)
s += buff[i].ToString("X2");
return s;
}
/// <summary>
/// 编码
/// </summary>
/// <param name="node">单个节点</param>
/// <returns></returns>
public static byte[] Encode(Node node)
{
try
{
string json = JsonHelper.SerializeObject(node);
log.debug(string.Format("Encode[{0}]", json));
byte[] body = Encoding.UTF8.GetBytes(json);
byte[] bodySize = IntToByteArray(body.Length);
byte[] buff = headPack.Concat(bodySize).Concat(body).ToArray();
return buff;
}
catch (Exception ex)
{
log.error("Encode Error", ex);
return null;
}
}
/// <summary>
/// 编码
/// </summary>
/// <param name="nodes">多个节点</param>
/// <returns></returns>
public static byte[] Encode(List<Node> nodes)
{
try
{
string json = JsonHelper.SerializeObject(nodes);
log.debug(string.Format("Encode[{0}]", json));
byte[] body = Encoding.UTF8.GetBytes(json);
byte[] bodySize = IntToByteArray(body.Length);
byte[] buff = headPack.Concat(bodySize).Concat(body).ToArray();
log.debug(string.Format("headPack:{0}", Common.HexBuff(Common.headPack)));
log.debug(string.Format("bodysize:{0}[{1}]", Common.HexBuff(bodySize), body.Length));
log.debug(string.Format("body:{0}", Common.HexBuff(body)));
return buff;
}
catch (Exception ex)
{
log.error("Encode Error", ex);
return null;
}
}
/// <summary>
/// 解码单个节点
/// </summary>
/// <param name="buff"></param>
/// <returns></returns>
public static Node Decode(byte[] buff)
{
try
{
string json = System.Text.Encoding.UTF8.GetString(buff);
log.debug(string.Format("Decode[{0}]", json));
Node node = JsonHelper.DeserializeJsonToObject<Node>(json);
return node;
}
catch (Exception ex)
{
log.error("Decode Error", ex);
return null;
}
}
/// <summary>
/// 解码多个节点
/// </summary>
/// <param name="buff"></param>
/// <returns></returns>
public static List<Node> DecodeNodes(byte[] buff)
{
try
{
string json = System.Text.Encoding.UTF8.GetString(buff);
log.debug(string.Format("DecodeNodes[{0}]", json));
List<Node> node = JsonHelper.DeserializeJsonToList<Node>(json);
return node;
}
catch (Exception ex)
{
log.error("Decode Error", ex);
return null;
}
}
//将数字转换成字节数组
//由数字创建字节数组
public static byte[] IntToByteArray(Int32 src)
{
//创建内存流MemoryStream,stream作为存放 二进制数据 的缓存
using (MemoryStream stream = new MemoryStream())
{
//创建一个BinaryWriter来写二进制数据到stream
using (BinaryWriter write = new BinaryWriter(stream))
{
write.Write(src);//将十进制数字src写到stream中,
return stream.ToArray();//将写到stream中的二进制数据转为字节数组
}
}
}
}
/// <summary>
/// 客户端的动作
/// </summary>
public enum ClientAction : byte
{
/// <summary>
/// 没有动作
/// </summary>
None,
/// <summary>
/// 完成(服务器发送)
/// </summary>
CloseDoor,
/// <summary>
/// 可以进入料架
/// </summary>
MayEnter,
/// <summary>
/// 可以流出料架
/// </summary>
MayLeave,
/// <summary>
/// 需要进入料架
/// </summary>
NeedEnter,
/// <summary>
/// 需要流出料架
/// </summary>
NeedLeave,
/// <summary>
/// 完成进入料架
/// </summary>
FinishEnter,
/// <summary>
/// 完成流出料架
/// </summary>
FinishLeave,
/// <summary>
/// 到达包装料仓门口(服务器发送)
/// </summary>
Arrive,
/// <summary>
/// 小车准备好(服务器发送)
/// </summary>
Ready,
/// <summary>
/// 只能入料不能出料(仅包装料仓)
/// </summary>
EnterShelf,
/// <summary>
/// 不允许
/// </summary>
MayNot,
/// <summary>
/// 需要进入流出料架
/// </summary>
NeedEnterLeave,
/// <summary>
/// 可以停靠
/// </summary>
MayDock,
/// <summary>
/// 不可以进入料架
/// </summary>
MayNotEnter,
/// <summary>
/// 不可以流出料架
/// </summary>
MayNotLeave,
/// <summary>
/// 不可以停靠
/// </summary>
MayNotDock,
/// <summary>
/// 小车准备好送出料架(服务器发送)
/// </summary>
ReadyEnter,
/// <summary>
/// 小车准备好进入料架(服务器发送)
/// </summary>
ReadyLeave,
/// <summary>
/// 完成(服务器发送)
/// </summary>
Complete,
}
/// <summary>
/// 客户端的优先级
/// </summary>
public enum ClientLevel : byte
{
/// <summary>
/// 低
/// </summary>
Low,
/// <summary>
/// 中等
/// </summary>
Middle,
/// <summary>
/// 高
/// </summary>
High,
None,
}
/// <summary>
/// 客户端的料架
/// </summary>
public enum ClientShelf
{
/// <summary>
/// 没有架子
/// </summary>
None,
/// <summary>
/// 空架子
/// </summary>
Empty,
/// <summary>
/// 满料架子
/// </summary>
Full
}
/// <summary>
/// 类型
/// </summary>
public enum ClientType
{
/// <summary>
/// 无
/// </summary>
None,
/// <summary>
/// 紧急料
/// </summary>
Urgent,
/// <summary>
/// 包装料
/// </summary>
Pack,
/// <summary>
/// 分盘料
/// </summary>
Cut
}
}