AGVInfoService.cs 93 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172
  1. using System;
  2. using System.Collections.Generic;
  3. using System.Linq;
  4. using System.Text;
  5. using AGV_WPF.Models;
  6. using System.Configuration;
  7. using AGV_WPF_Global;
  8. using System.Threading;
  9. using System.ComponentModel;
  10. using AGV_WPF.NewCotent;
  11. using TrafficDll;
  12. namespace AGV_WPF.DataControl
  13. {
  14. public class AGVInfoService : IDisposable
  15. {
  16. #region 初始化缓存表
  17. Traffic kwtraffic;
  18. public void InitTraffic()
  19. {
  20. //kwtraffic = new Traffic();
  21. ////traffic_1 = new Traffic();
  22. //Thread GetTrafficAgvThread = new Thread(new ThreadStart(getTrafficAgvServer));
  23. //GetTrafficAgvThread.Start();
  24. }
  25. /// <summary>
  26. /// 初始化AGV缓存表数据
  27. /// </summary>
  28. /// <param name="AGVNUM_MAX"></param>
  29. public void InitAgvBuffer()
  30. {
  31. int AGVNUM_MAX = Convert.ToInt16(ConfigurationManager.AppSettings["AGVNUM_MAX"]);
  32. AGVInfoModel agv = null;
  33. IDictionary<int, AGVInfoModel> AgvDictionary = GlobalPara.AgvInfoDic;
  34. AgvDictionary.Clear();
  35. for (int i = 1; i <= AGVNUM_MAX; i++)
  36. {
  37. agv = new AGVInfoModel(i);
  38. AgvDictionary.Add(i, agv);
  39. }
  40. }
  41. #endregion
  42. #region 数据库增删改查操作
  43. /// <summary>
  44. /// 新增AGV信息
  45. /// </summary>
  46. /// <param name="agv"></param>
  47. /// <returns></returns>
  48. public void Add(AGVInfoModel agv)
  49. {
  50. DAL.ZSql sqlDelete = new DAL.ZSql();//数据库访问变量定义
  51. sqlDelete.Open("Insert into BAS_AGVINFO (AGVNUM,AGVNAME,MARKNUM,MARKFUN,RUNSTATUS,ROUTENUM,SPEEDLEVEL,ALARMCODE,ALARMINFO,"
  52. + "ConnectStatus,OffLineCount,IsMainAgv,TrafficNum,TrafficAgv) VALUES ("
  53. + agv.AGVNUM.ToString() + ",'" + agv.AGVNAME + "'," + agv.MARKNUM + ",'" + agv.MARKFUN + "',"
  54. + agv.RUNSTATUS + "," + agv.ROUTENUM + "," + agv.SPEEDLEVEL + "," + agv.ALARMCODE + ",'" + agv.ALARMINFO
  55. + agv.ConnectStatus + "," + agv.OffLineCount + "," + agv.IsMainAgv + "," + agv.TRAFFICNUM + "," + agv.TRAFFICAGV + "')");
  56. sqlDelete.Close();
  57. }
  58. /// <summary>
  59. /// 删除AGV信息
  60. /// </summary>
  61. /// <param name="agv"></param>
  62. /// <returns></returns>
  63. public bool Delete(AGVInfoModel agv)
  64. {
  65. DAL.ZSql sqlDelete = new DAL.ZSql();//数据库访问变量定义
  66. sqlDelete.Open("delete BAS_AGVINFO where AGVNUM='" + agv.AGVNUM.ToString() + "'");
  67. if (sqlDelete.rowcount > 0)
  68. {
  69. sqlDelete.Close();
  70. return true;
  71. }
  72. else
  73. {
  74. sqlDelete.Close();
  75. return false;
  76. }
  77. }
  78. /// <summary>
  79. /// 删除AGV信息
  80. /// </summary>
  81. /// <param name="agvnum"></param>
  82. /// <returns></returns>
  83. public bool Delete(int agvnum)
  84. {
  85. DAL.ZSql sqlDelete = new DAL.ZSql();//数据库访问变量定义
  86. sqlDelete.Open("delete BAS_AGVINFO where AGVNUM='" + agvnum.ToString() + "'");
  87. if (sqlDelete.rowcount > 0)
  88. {
  89. sqlDelete.Close();
  90. return true;
  91. }
  92. else
  93. {
  94. sqlDelete.Close();
  95. return false;
  96. }
  97. }
  98. /// <summary>
  99. /// 更新AGVINFO表信息
  100. /// </summary>
  101. /// <param name="agv"></param>
  102. public void Update(AGVInfoModel agv)
  103. {
  104. DAL.ZSql sqlUpdate = new DAL.ZSql();//数据库访问变量定义
  105. sqlUpdate.Open("Update BAS_AGVINFO(AGVNUM,AGVNAME,MARKNUM,MARKFUN,RUNSTATUS,ROUTENUM,SPEEDLEVEL,ALARMCODE,ALARMINFO,"
  106. + "ConnectStatus,OffLineCount,IsMainAgv,TrafficNum,TrafficAgv) VALUES ("
  107. + agv.AGVNUM.ToString() + ",'" + agv.AGVNAME + "'," + agv.MARKNUM + "," + agv.MARKFUN + "," + agv.RUNSTATUS
  108. + "," + agv.ROUTENUM + "," + agv.SPEEDLEVEL + "," + agv.ALARMCODE + ",'" + agv.ALARMINFO + "',"
  109. + agv.ConnectStatus + "," + agv.OffLineCount + "," + agv.IsMainAgv + "," + agv.TRAFFICNUM + "," + agv.TRAFFICAGV + "");
  110. sqlUpdate.Close();
  111. }
  112. /// <summary>
  113. /// 获取AGV信息数据
  114. /// </summary>
  115. /// <param name="agvnum"></param>
  116. /// <returns></returns>
  117. public AGVInfoModel GetAGVINFO(int agvnum)
  118. {
  119. DAL.ZSql dtAgvInfo = new DAL.ZSql();//数据库访问变量定义
  120. dtAgvInfo.Open("select AGVNUM,AGVNAME,MARKNUM,MARKFUN,RUNSTATUS,ROUTENUM,SPEEDLEVEL,ALARMCODE,ALARMINFO,"
  121. + "ConnectStatus,OffLineCount,IsMainAgv,TrafficNum,TrafficAgv from BAS_AGVINFO where AGVNUM='" + agvnum.ToString() + "'");
  122. AGVInfoModel agv = new AGVInfoModel();
  123. if (dtAgvInfo.rowcount > 0)
  124. {
  125. #region 数据字段赋值
  126. agv.AGVNUM = Convert.ToByte(dtAgvInfo.Rows[0]["AGVNUM"].ToString());
  127. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[0]["AGVNAME"].ToString()))
  128. {
  129. agv.AGVNAME = dtAgvInfo.Rows[0]["AGVNAME"].ToString();
  130. }
  131. else
  132. {
  133. agv.AGVNAME = "";
  134. }
  135. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[0]["MARKNUM"].ToString()))
  136. {
  137. agv.MARKNUM = Convert.ToByte(dtAgvInfo.Rows[0]["MARKNUM"]);
  138. }
  139. else
  140. {
  141. agv.MARKNUM = 0;
  142. }
  143. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[0]["MARKFUN"].ToString()))
  144. {
  145. agv.MARKFUN = Convert.ToByte(dtAgvInfo.Rows[0]["MARKFUN"]);
  146. }
  147. else
  148. {
  149. agv.MARKFUN = 0;
  150. }
  151. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[0]["RUNSTATUS"].ToString()))
  152. {
  153. agv.RUNSTATUS = Convert.ToByte(dtAgvInfo.Rows[0]["RUNSTATUS"]);
  154. }
  155. else
  156. {
  157. agv.RUNSTATUS = 0;
  158. }
  159. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[0]["ROUTENUM"].ToString()))
  160. {
  161. agv.ROUTENUM = Convert.ToByte(dtAgvInfo.Rows[0]["ROUTENUM"]);
  162. }
  163. else
  164. {
  165. agv.ROUTENUM = 0;
  166. }
  167. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[0]["SPEEDLEVEL"].ToString()))
  168. {
  169. agv.SPEEDLEVEL = Convert.ToByte(dtAgvInfo.Rows[0]["SPEEDLEVEL"]);
  170. }
  171. else
  172. {
  173. agv.SPEEDLEVEL = 0;
  174. }
  175. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[0]["ALARMCODE"].ToString()))
  176. {
  177. agv.ALARMCODE = dtAgvInfo.Rows[0]["ALARMCODE"].ToString();
  178. }
  179. else
  180. {
  181. agv.ALARMCODE = "无";
  182. }
  183. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[0]["ALARMINFO"].ToString()))
  184. {
  185. agv.ALARMINFO = dtAgvInfo.Rows[0]["ALARMINFO"].ToString();
  186. }
  187. else
  188. {
  189. agv.ALARMINFO = "无";
  190. }
  191. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[0]["ConnectStatus"].ToString()))
  192. {
  193. agv.ConnectStatus = Convert.ToBoolean(dtAgvInfo.Rows[0]["ConnectStatus"]);
  194. }
  195. else
  196. {
  197. agv.ConnectStatus = false;
  198. }
  199. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[0]["OffLineCount"].ToString()))
  200. {
  201. agv.OffLineCount = Convert.ToInt16(dtAgvInfo.Rows[0]["OffLineCount"]);
  202. }
  203. else
  204. {
  205. agv.OffLineCount = 0;
  206. }
  207. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[0]["OffLineCount"].ToString()))
  208. {
  209. agv.IsMainAgv = Convert.ToBoolean(dtAgvInfo.Rows[0]["IsMainAgv"]);
  210. }
  211. else
  212. {
  213. agv.IsMainAgv = false;
  214. }
  215. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[0]["TRAFFICNUM"].ToString()))
  216. {
  217. int anum = Convert.ToInt16(dtAgvInfo.Rows[0]["TrafficNum"]);
  218. agv.TRAFFICNUM.Add(GlobalPara.TrafficBuffer[anum]);
  219. }
  220. else
  221. {
  222. agv.TRAFFICNUM.Clear();
  223. }
  224. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[0]["TRAFFICAGV"].ToString()))
  225. {
  226. int anum = Convert.ToInt16(dtAgvInfo.Rows[0]["TrafficAgv"]);
  227. agv.TRAFFICAGV = GlobalPara.AgvInfoDic[anum];
  228. }
  229. else
  230. {
  231. agv.TRAFFICAGV = null;
  232. }
  233. #endregion
  234. }
  235. dtAgvInfo.Close();
  236. return agv;
  237. }
  238. /// <summary>
  239. /// 获取所有AGVinfo信息
  240. /// </summary>
  241. /// <param name="agvnum"></param>
  242. /// <returns></returns>
  243. public List<AGVInfoModel> GetALL()
  244. {
  245. DAL.ZSql dtAgvInfo = new DAL.ZSql();//数据库访问变量定义
  246. dtAgvInfo.Open("select AGVNUM,AGVNAME,MARKNUM,MARKFUN,RUNSTATUS,ROUTENUM,SPEEDLEVEL,ALARMCODE,ALARMINFO,"
  247. + "ConnectStatus,OffLineCount,IsMainAgv,TrafficNum,TrafficAgv from BAS_AGVINFO");
  248. List<AGVInfoModel> listagv = new List<AGVInfoModel>(); //存放所有AGVINFO的列表
  249. AGVInfoModel agv = null;//存放1台rowcountAGV的对象
  250. int agvnum = 0;
  251. for (int i = 0; i < dtAgvInfo.rowcount; i++)
  252. {
  253. agv = new AGVInfoModel();
  254. agvnum = Convert.ToInt16(dtAgvInfo.Rows[i]["AGVNUM"]);
  255. #region 数据字段赋值
  256. agv.AGVNUM = agvnum;
  257. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[i]["AGVNAME"].ToString()))
  258. {
  259. agv.AGVNAME = dtAgvInfo.Rows[i]["AGVNAME"].ToString();
  260. }
  261. else
  262. {
  263. agv.AGVNAME = "";
  264. }
  265. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[i]["MARKNUM"].ToString()))
  266. {
  267. agv.MARKNUM = Convert.ToByte(dtAgvInfo.Rows[i]["MARKNUM"]);
  268. }
  269. else
  270. {
  271. agv.MARKNUM = 0;
  272. }
  273. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[i]["MARKFUN"].ToString()))
  274. {
  275. agv.MARKFUN = Convert.ToByte(dtAgvInfo.Rows[i]["MARKFUN"]);
  276. }
  277. else
  278. {
  279. agv.MARKFUN = 0;
  280. }
  281. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[i]["RUNSTATUS"].ToString()))
  282. {
  283. agv.RUNSTATUS = Convert.ToByte(dtAgvInfo.Rows[i]["RUNSTATUS"]);
  284. }
  285. else
  286. {
  287. agv.RUNSTATUS = 0;
  288. }
  289. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[i]["ROUTENUM"].ToString()))
  290. {
  291. agv.ROUTENUM = Convert.ToByte(dtAgvInfo.Rows[i]["ROUTENUM"]);
  292. }
  293. else
  294. {
  295. agv.ROUTENUM = 0;
  296. }
  297. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[i]["SPEEDLEVEL"].ToString()))
  298. {
  299. agv.SPEEDLEVEL = Convert.ToByte(dtAgvInfo.Rows[i]["SPEEDLEVEL"]);
  300. }
  301. else
  302. {
  303. agv.SPEEDLEVEL = 0;
  304. }
  305. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[i]["ALARMCODE"].ToString()))
  306. {
  307. agv.ALARMCODE = dtAgvInfo.Rows[i]["ALARMCODE"].ToString();
  308. }
  309. else
  310. {
  311. agv.ALARMCODE = "无";
  312. }
  313. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[i]["ALARMINFO"].ToString()))
  314. {
  315. agv.ALARMINFO = dtAgvInfo.Rows[i]["ALARMINFO"].ToString();
  316. }
  317. else
  318. {
  319. agv.ALARMINFO = "无";
  320. }
  321. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[i]["ConnectStatus"].ToString()))
  322. {
  323. agv.ConnectStatus = Convert.ToBoolean(dtAgvInfo.Rows[i]["ConnectStatus"]);
  324. }
  325. else
  326. {
  327. agv.ConnectStatus = false;
  328. }
  329. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[i]["OffLineCount"].ToString()))
  330. {
  331. agv.OffLineCount = Convert.ToInt16(dtAgvInfo.Rows[i]["OffLineCount"]);
  332. }
  333. else
  334. {
  335. agv.OffLineCount = 0;
  336. }
  337. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[i]["OffLineCount"].ToString()))
  338. {
  339. agv.IsMainAgv = Convert.ToBoolean(dtAgvInfo.Rows[i]["IsMainAgv"]);
  340. }
  341. else
  342. {
  343. agv.IsMainAgv = false;
  344. }
  345. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[i]["TRAFFICNUM"].ToString()))
  346. {
  347. int tnum = Convert.ToInt16(dtAgvInfo.Rows[0]["TrafficNum"]);
  348. agv.TRAFFICNUM.Add(GlobalPara.TrafficBuffer[tnum]);
  349. }
  350. else
  351. {
  352. agv.TRAFFICNUM.Clear();
  353. }
  354. if (!string.IsNullOrEmpty(dtAgvInfo.Rows[i]["TRAFFICAGV"].ToString()))
  355. {
  356. int num = Convert.ToInt16(dtAgvInfo.Rows[0]["TrafficAgv"]);
  357. agv.TRAFFICAGV = GlobalPara.AgvInfoDic[num];
  358. }
  359. else
  360. {
  361. agv.TRAFFICAGV = null;
  362. }
  363. #endregion
  364. if (agv != null)
  365. {
  366. listagv.Add(agv);
  367. }
  368. }
  369. dtAgvInfo.Close();
  370. return listagv;
  371. }
  372. #endregion
  373. #region 更新缓存区AGV数据11
  374. /// <summary>
  375. /// 更新缓存区AGV运行数据
  376. /// </summary>
  377. /// <param name="agvdata">agv回复中控的数据</param>
  378. //public void UpdateBuffer(byte[] agvdata)
  379. //{
  380. // if (agvdata.Count() >=10)
  381. // {
  382. // int agvnum = agvdata[2];//agv编号
  383. // if (GlobalPara.AgvInfoDic.ContainsKey(agvnum))
  384. // {
  385. // //agv类
  386. // AGVInfoModel agvinfo = GlobalPara.AgvInfoDic[agvnum];
  387. // agvinfo.AGVNUM = agvnum;
  388. // //地标卡号
  389. // int markNum = Convert.ToInt16(agvdata[3] | ((agvdata[7] & 0xC0) << 2));
  390. // agvinfo.MARKNUM = markNum;
  391. // {
  392. // #region 管制区
  393. // TrafficAreaService trafficService = new TrafficAreaService();
  394. // //上一管制区号
  395. // int lastTrafficNum = agvinfo.PTRAFFICNUM;
  396. // //当前管制区号
  397. // int currentTrafficNum;
  398. // //获取当前地标位置是否在管制区内
  399. // TrafficAreaModel traffic = trafficService.GetTraffic(markNum);
  400. // if (traffic != null)
  401. // {
  402. // currentTrafficNum = traffic.TrafficNum;
  403. // }
  404. // else
  405. // {
  406. // currentTrafficNum = 0;
  407. // }
  408. // TrafficAreaModel lastTraffic = null;
  409. // //获取上一管制区
  410. // if(GlobalPara.TrafficBuffer.Keys.Contains(lastTrafficNum))
  411. // {
  412. // lastTraffic = GlobalPara.TrafficBuffer[lastTrafficNum];
  413. // }
  414. // if (traffic != null)
  415. // {
  416. // #region 管制区内的情况
  417. // if (lastTrafficNum == 0)
  418. // {
  419. // #region agv从管制区外进入管制区内
  420. // traffic.InTraffic(agvinfo);//AGV加入管制区
  421. // //agvinfo.TRAFFICNUM = traffic.TrafficNum;
  422. // #endregion
  423. // }
  424. // else if (lastTrafficNum != 0)
  425. // {
  426. // if (lastTrafficNum != currentTrafficNum)
  427. // {
  428. // if (lastTraffic != null)
  429. // {
  430. // #region 从管制区A进入管制区B内
  431. // if (lastTraffic.OutTraffic(agvinfo))
  432. // {
  433. // traffic.InTraffic(agvinfo);
  434. // agvinfo.PTRAFFICNUM = agvinfo.PTRAFFICNUM;
  435. // //agvinfo.TRAFFICNUM = traffic.TrafficNum;
  436. // }
  437. // #endregion
  438. // }
  439. // }
  440. // }
  441. // #endregion
  442. // //agvinfo.TRAFFICNUM = traffic.TrafficNum;//当前管制区
  443. // }
  444. // else
  445. // {
  446. // #region 管制区外的情况
  447. // if (lastTrafficNum != 0 && currentTrafficNum == 0)
  448. // {
  449. // //agv从管制区内驶出管制区外
  450. // if(lastTraffic!=null) lastTraffic.OutTraffic(agvinfo);
  451. // }
  452. // #endregion
  453. // agvinfo.TRAFFICNUM = new List<TrafficAreaModel>();//当前管制区
  454. // }
  455. // #endregion
  456. // }
  457. // //当前地标功能
  458. // if (agvdata[4] > 0 && agvdata[4] < 32)
  459. // {
  460. // agvinfo.MARKFUN = agvdata[4];
  461. // }
  462. // agvinfo.RUNSTATUS = agvdata[5];
  463. // //报警信息处理
  464. // switch (agvdata[5])
  465. // {
  466. // #region 异常分类
  467. // case 1:
  468. // agvinfo.ALARMCODE = "1";
  469. // agvinfo.ALARMINFO = "无异常";
  470. // break;
  471. // case 2:
  472. // agvinfo.ALARMCODE = "2";
  473. // agvinfo.ALARMINFO = "急停报警";
  474. // break;
  475. // case 3:
  476. // agvinfo.ALARMCODE = "3";
  477. // agvinfo.ALARMINFO = "防撞报警";
  478. // break;
  479. // case 4:
  480. // agvinfo.ALARMCODE = "4";
  481. // agvinfo.ALARMINFO = "牵引棒报警";
  482. // break;
  483. // case 5:
  484. // agvinfo.ALARMCODE = "5";
  485. // agvinfo.ALARMINFO = "障碍物";
  486. // break;
  487. // case 6:
  488. // agvinfo.ALARMCODE = "6";
  489. // agvinfo.ALARMINFO = "跑错路线";
  490. // break;
  491. // case 7:
  492. // agvinfo.ALARMCODE = "7";
  493. // agvinfo.ALARMINFO = "电压报警";
  494. // break;
  495. // case 8:
  496. // agvinfo.ALARMCODE = "8";
  497. // agvinfo.ALARMINFO = "脱轨报警";
  498. // break;
  499. // case 9:
  500. // agvinfo.ALARMCODE = "9";
  501. // agvinfo.ALARMINFO = "低电压报警";
  502. // break;
  503. // case 10:
  504. // agvinfo.ALARMCODE = "10";
  505. // agvinfo.ALARMINFO = "低电压停机";
  506. // break;
  507. // case 11:
  508. // agvinfo.ALARMCODE = "11";
  509. // agvinfo.ALARMINFO = "超载报警";
  510. // break;
  511. // default:
  512. // agvinfo.ALARMCODE = "-1";
  513. // agvinfo.ALARMINFO = "未知异常";
  514. // break;
  515. // #endregion
  516. // }
  517. // agvinfo.ROUTENUM = agvdata[6];
  518. // //速度等级
  519. // int SpeedGrade = agvdata[7] & 0x3F;
  520. // if (SpeedGrade > 0 && SpeedGrade < 6)
  521. // {
  522. // agvinfo.SPEEDLEVEL = SpeedGrade;
  523. // }
  524. // agvinfo.OffLineCount = 0;
  525. // agvinfo.ConnectStatus = true;
  526. // }
  527. // }
  528. //}
  529. #endregion
  530. #region 更新缓存区AGV数据22
  531. public void UpdateBufferOld(List<byte> agvdata)
  532. {
  533. string a = "";
  534. if (agvdata.Count >= 10)
  535. {
  536. int agvnum = agvdata[2];//agv编号
  537. if (GlobalPara.AgvInfoDic.ContainsKey(agvnum))
  538. {
  539. #region 属性更新
  540. //agv类
  541. AGVInfoModel agvinfo = GlobalPara.AgvInfoDic[agvnum];
  542. agvinfo.AGVNUM = agvnum;
  543. //----------------------------------------------------------------------
  544. /**修改人:胡文辉
  545. * 修改日期:2017-10-14
  546. * 修改内容:由于协议更改,获取地标卡号和路线编号的位置做了调整。
  547. * */
  548. //agvinfo.MARKNUM = agvdata[3] | ((agvdata[9] & 0xFF) << 8);
  549. if (!GlobalPara.UseNewProtrol)
  550. {
  551. agvinfo.MARKNUM = Convert.ToInt16(agvdata[3] | ((agvdata[7] & 0xC0) << 2));
  552. agvinfo.ROUTENUM = agvdata[6];
  553. if (agvdata[4] > 0 && agvdata[4] < 32)
  554. {
  555. agvinfo.MARKFUN = agvdata[4];
  556. }
  557. agvinfo.RUNSTATUS = agvdata[5];
  558. //报警信息处理
  559. switch (agvdata[5])
  560. {
  561. #region 异常分类
  562. case 1:
  563. agvinfo.ALARMCODE = "1";
  564. agvinfo.ALARMINFO = "无异常";
  565. break;
  566. case 2:
  567. agvinfo.ALARMCODE = "2";
  568. agvinfo.ALARMINFO = "急停报警";
  569. break;
  570. case 3:
  571. agvinfo.ALARMCODE = "3";
  572. agvinfo.ALARMINFO = "防撞报警";
  573. break;
  574. case 4:
  575. agvinfo.ALARMCODE = "4";
  576. agvinfo.ALARMINFO = "牵引棒报警";
  577. break;
  578. case 5:
  579. agvinfo.ALARMCODE = "5";
  580. agvinfo.ALARMINFO = "障碍物";
  581. break;
  582. case 6:
  583. agvinfo.ALARMCODE = "6";
  584. agvinfo.ALARMINFO = "跑错路线";
  585. break;
  586. case 7:
  587. agvinfo.ALARMCODE = "7";
  588. agvinfo.ALARMINFO = "电压报警";
  589. break;
  590. case 8:
  591. agvinfo.ALARMCODE = "8";
  592. agvinfo.ALARMINFO = "脱轨报警";
  593. break;
  594. case 9:
  595. agvinfo.ALARMCODE = "9";
  596. agvinfo.ALARMINFO = "低电压报警";
  597. break;
  598. case 10:
  599. agvinfo.ALARMCODE = "10";
  600. agvinfo.ALARMINFO = "低电压停机";
  601. break;
  602. case 11:
  603. agvinfo.ALARMCODE = "11";
  604. agvinfo.ALARMINFO = "超载报警";
  605. break;
  606. default:
  607. agvinfo.ALARMCODE = "-1";
  608. agvinfo.ALARMINFO = "未知异常";
  609. break;
  610. #endregion
  611. }
  612. //速度等级
  613. int SpeedGrade = agvdata[7] & 0x3F;
  614. if (SpeedGrade > 0 && SpeedGrade < 6)
  615. {
  616. agvinfo.SPEEDLEVEL = SpeedGrade;
  617. }
  618. agvinfo.OffLineCount = 0;
  619. agvinfo.ConnectStatus = true;
  620. }
  621. else
  622. {
  623. //19位数据解析
  624. if (agvdata.Count >= 19)
  625. {
  626. agvinfo.MARKNUM = ((int)agvdata[3] << 8 | agvdata[4]);
  627. agvinfo.ROUTENUM = ((int)agvdata[8] << 8 | agvdata[9]);
  628. if (agvdata[5] > 0 && agvdata[5] < 32)
  629. {
  630. agvinfo.MARKFUN = agvdata[5];
  631. }
  632. agvinfo.RUNSTATUS = agvdata[7];
  633. switch (agvdata[6])
  634. {
  635. #region 异常分类
  636. case 1:
  637. agvinfo.ALARMCODE = "1";
  638. agvinfo.ALARMINFO = "无异常";
  639. break;
  640. case 2:
  641. agvinfo.ALARMCODE = "2";
  642. agvinfo.ALARMINFO = "急停报警";
  643. break;
  644. case 3:
  645. agvinfo.ALARMCODE = "3";
  646. agvinfo.ALARMINFO = "防撞报警";
  647. break;
  648. case 4:
  649. agvinfo.ALARMCODE = "4";
  650. agvinfo.ALARMINFO = "牵引棒报警";
  651. break;
  652. case 5:
  653. agvinfo.ALARMCODE = "5";
  654. agvinfo.ALARMINFO = "障碍物";
  655. break;
  656. case 6:
  657. agvinfo.ALARMCODE = "6";
  658. agvinfo.ALARMINFO = "跑错路线";
  659. break;
  660. case 7:
  661. agvinfo.ALARMCODE = "7";
  662. agvinfo.ALARMINFO = "电压报警";
  663. break;
  664. case 8:
  665. agvinfo.ALARMCODE = "8";
  666. agvinfo.ALARMINFO = "脱轨报警";
  667. break;
  668. case 9:
  669. agvinfo.ALARMCODE = "9";
  670. agvinfo.ALARMINFO = "低电压报警";
  671. break;
  672. case 10:
  673. agvinfo.ALARMCODE = "10";
  674. agvinfo.ALARMINFO = "低电压停机";
  675. break;
  676. case 11:
  677. agvinfo.ALARMCODE = "11";
  678. agvinfo.ALARMINFO = "超载报警";
  679. break;
  680. default:
  681. agvinfo.ALARMCODE = "-1";
  682. agvinfo.ALARMINFO = "未知异常";
  683. break;
  684. #endregion
  685. }
  686. if (agvdata[6] != 0)
  687. {
  688. agvinfo.RUNSTATUS = agvdata[6];
  689. }
  690. //agvinfo.ALARMCODE = ((int)agvdata[6]).ToString() ;
  691. int SpeedGrade = agvdata[10];
  692. if (SpeedGrade > 0 && SpeedGrade < 6)
  693. {
  694. agvinfo.SPEEDLEVEL = SpeedGrade;
  695. }
  696. agvinfo.OffLineCount = 0;
  697. agvinfo.ConnectStatus = true;
  698. agvinfo.Bttery_Voltage = (decimal)(((int)agvdata[3] << 11 | agvdata[12]) / 100.0);
  699. agvinfo.Battery_Electricity = (decimal)(((int)agvdata[13] << 11 | agvdata[14]) / 100.0);
  700. }
  701. }
  702. #endregion
  703. #region 管制区逻辑处理部分
  704. TrafficAreaService trafficService = new TrafficAreaService();
  705. //前管制区号
  706. //拷贝一份另存为
  707. if (agvinfo.PTRAFFICNUM != agvinfo.TRAFFICNUM)
  708. {
  709. agvinfo.PTRAFFICNUM.Clear();
  710. agvinfo.PTRAFFICNUM.AddRange(agvinfo.TRAFFICNUM);
  711. }
  712. //最新管制区号
  713. //获取当前地标位置是否在管制区内
  714. List<TrafficAreaModel> newTrafficList = trafficService.GetTrafficList(agvinfo.MARKNUM, agvinfo.ROUTENUM, agvnum);
  715. List<TrafficAreaModel> outTrafficList = new List<TrafficAreaModel>();
  716. outTrafficList.AddRange(agvinfo.PTRAFFICNUM);
  717. bool isChange = CheckChange(agvinfo.TRAFFICNUM, newTrafficList);
  718. //检查旧管制区与新管制区是否有变化,有变化才需要检查AGV的管制状态的逻辑变化。
  719. if (isChange)
  720. {
  721. #region 管制区数据更新
  722. if (newTrafficList.Count > 0)
  723. {
  724. #region 标明进入了管制区(交叉管制区或独立管制区)
  725. {
  726. foreach (TrafficAreaModel traffic in newTrafficList)
  727. {
  728. //添加AGV的管制区对象列表
  729. if (!agvinfo.TRAFFICNUM.Contains(traffic))
  730. {
  731. //添加最新的管制区
  732. agvinfo.TRAFFICNUM.Add(traffic);
  733. //管制区有AGV进入
  734. traffic.AGVINTER(agvinfo, false);
  735. }
  736. if (outTrafficList.Contains(traffic))
  737. {
  738. outTrafficList.Remove(traffic);
  739. }
  740. }
  741. }
  742. //循环把AGV已经退出的管制区给处理一下。
  743. foreach (TrafficAreaModel traffic in outTrafficList)
  744. {
  745. //管制区有AGV离开
  746. agvinfo.TRAFFICNUM.Remove(traffic);
  747. traffic.AGVLEAVE(agvinfo);
  748. if (traffic.listAgvQueue.Count > 0)
  749. {
  750. traffic.ReleaseAgv(); //调用放行事件
  751. }
  752. }
  753. #endregion
  754. }
  755. else
  756. {
  757. #region 表示AGV现在不在任何管制区
  758. foreach (TrafficAreaModel traffic in outTrafficList)
  759. {
  760. agvinfo.TRAFFICNUM.Remove(traffic);
  761. traffic.AGVLEAVE(agvinfo);
  762. if (traffic.listAgvQueue.Count > 0)
  763. {
  764. traffic.ReleaseAgv(); //调用放行事件
  765. }
  766. }
  767. if (agvinfo.TrafficFlag)
  768. {
  769. agvinfo.TrafficFlag = false;
  770. agvinfo.TRAFFICAGV = null;
  771. }
  772. #endregion
  773. }
  774. #endregion
  775. #region 管制区的数据更新后,判定AGV的管制状态
  776. //AGV只有在所有管制区成为主机的情况下,才能不被管制
  777. bool isTraffic = false;//标识AGV是否应该被管制,true表示应该不管制;false表示不应该不管制
  778. //int agv=0;
  779. #region 遍历AGV现在的管制区,寻找是否有某个管制区还管制着本AGV(我自己)
  780. foreach (var traffic in agvinfo.TRAFFICNUM)
  781. {
  782. //一旦发现AGV在某个管制区还不是主机,则把AGV管制住
  783. if (agvinfo != traffic.MainAgv)
  784. {
  785. if (traffic.listAgvQueue.Contains(traffic.MainAgv))
  786. {
  787. traffic.MainAgv = agvinfo;
  788. agvinfo.TrafficFlag = false;
  789. isTraffic = false;
  790. break;
  791. }
  792. else
  793. {
  794. isTraffic = true;
  795. agvinfo.TRAFFICAGV = traffic.MainAgv;//---LG修改方便查看主机
  796. break;
  797. }
  798. }
  799. }
  800. #endregion
  801. #region 发现AGV需要被管制
  802. if (isTraffic)
  803. {
  804. agvinfo.TrafficFlag = true;
  805. }
  806. else
  807. {
  808. agvinfo.TrafficFlag = false;
  809. agvinfo.TRAFFICAGV = null;
  810. foreach (var traffic in outTrafficList)
  811. {
  812. if (traffic.MainAgv != null)
  813. {
  814. traffic.ReleaseMainAgv();
  815. }
  816. else
  817. {
  818. if (traffic.listAgvQueue.Count > 0)
  819. {
  820. traffic.ReleaseAgv(traffic.listAgvQueue[0]);
  821. }
  822. }
  823. }
  824. }
  825. #endregion
  826. #endregion
  827. #region 管制区数据更新日志记录
  828. //StringBuilder a1 = new StringBuilder();
  829. //foreach (var n in agvinfo.TRAFFICNUM)
  830. //{
  831. // a1.Append("->"+n.TrafficNum);
  832. //}
  833. //if (a1.Length > 1)
  834. //{
  835. // a1.Remove(0, 2);
  836. // a1.Append("|");
  837. //}
  838. //else
  839. //{
  840. // a1.Append("无");
  841. //}
  842. //string marktime = DateTime.Now.ToString("HH:mm:ss");
  843. //a = string.Format("{5} : AGV编号:{0} --AGV管制状态:{1} --当前地标:{2} --当前路线:{3} --当前管制区:{4} --当前AGV管制区主机:{6}", agvinfo.AGVNUM, agvinfo.TrafficFlag, agvinfo.MARKNUM, agvinfo.ROUTENUM, a1, marktime,agvinfo.TRAFFICAGV);
  844. //ErrorLog.WriteErrorLogagv(a);
  845. #endregion
  846. }
  847. #endregion
  848. #region 罗国--预防管制区只有一辆车还被管制住。
  849. bool SigleFlag = false;
  850. bool SigleFlag1 = false;
  851. if (agvinfo.TrafficFlag)
  852. {
  853. foreach (var agvtrffic in agvinfo.TRAFFICNUM)
  854. {
  855. if (agvinfo.TRAFFICAGV == null)//没有主机的时候不放行
  856. {
  857. if (agvtrffic.listAgvQueue.Count == 0)
  858. {
  859. SigleFlag = true;
  860. }
  861. else if (agvtrffic.listAgvQueue.Count == 1)
  862. {
  863. if (agvtrffic.listAgvQueue[0] == agvinfo)
  864. {
  865. SigleFlag = true;
  866. }
  867. }
  868. else
  869. {
  870. SigleFlag = false;
  871. break;
  872. }
  873. }
  874. else//有主机不放行
  875. {
  876. foreach (var agvtraffic1 in agvinfo.TRAFFICAGV.TRAFFICNUM)
  877. {
  878. if (agvtraffic1 == agvtrffic)//有相同的区域
  879. {
  880. SigleFlag1 = false;
  881. break;
  882. }
  883. else
  884. {
  885. SigleFlag1 = true;
  886. }
  887. }
  888. if (!SigleFlag1)
  889. {
  890. break;
  891. }
  892. }
  893. }
  894. if (SigleFlag)//确定只有一台AGV把AGV
  895. {
  896. agvinfo.TrafficFlag = false;
  897. foreach (var traffic1 in agvinfo.TRAFFICNUM)//清空队列中所有的AGV
  898. {
  899. traffic1.MainAgv = agvinfo;
  900. if (traffic1.listAgvQueue.Contains(agvinfo))
  901. {
  902. traffic1.listAgvQueue.Remove(agvinfo);
  903. }
  904. }
  905. }
  906. if (SigleFlag1)//有主机的处理,且主机不在管制区域内
  907. {
  908. agvinfo.TrafficFlag = false;
  909. foreach (var traffic2 in agvinfo.TRAFFICNUM)//清空队列中AGV的主机
  910. {
  911. traffic2.MainAgv = agvinfo;
  912. if (traffic2.listAgvQueue.Contains(agvinfo.TRAFFICAGV))
  913. {
  914. traffic2.listAgvQueue.Remove(agvinfo.TRAFFICAGV);
  915. }
  916. }
  917. }
  918. }
  919. #endregion
  920. #region 罗国--预防多管制区里互相管制
  921. if (agvinfo.TrafficFlag)//在被管制的前提下
  922. {
  923. if (agvinfo.TRAFFICNUM.Count >= 2)//在多个管制区的互相管制随机放行
  924. {
  925. if (agvinfo.TRAFFICAGV.TRAFFICAGV == agvinfo)//主机的主机等于主机说明互相管制了
  926. {
  927. agvinfo.TrafficFlag = false;
  928. foreach (var traffic1 in agvinfo.TRAFFICNUM)//清空队列中所有的AGV
  929. {
  930. traffic1.MainAgv = agvinfo;
  931. if (traffic1.listAgvQueue.Contains(agvinfo))
  932. {
  933. traffic1.listAgvQueue.Remove(agvinfo);
  934. }
  935. if (traffic1.listAgvQueue.Contains(agvinfo.TRAFFICAGV))//把被管制的agv放在各个管制区的队列第一位
  936. {
  937. traffic1.listAgvQueue.Remove(agvinfo.TRAFFICAGV);
  938. traffic1.listAgvQueue.Insert(0, agvinfo.TRAFFICAGV);
  939. }
  940. }
  941. }
  942. }
  943. }
  944. #endregion
  945. #region 避免关机重启后管制状态还保留,导致放行不了
  946. if (agvinfo.TRAFFICNUM.Count == 0)
  947. {
  948. agvinfo.TrafficFlag = false;
  949. agvinfo.TRAFFICAGV = null;
  950. }
  951. #endregion
  952. #region 在管制区中平行的时候就不管制了
  953. if (GlobalPara.IsEnablePallel)
  954. {
  955. agvinfo.ParallelFlag = CheckRouteFlag(agvinfo.MARKNUM, agvinfo.ROUTENUM, agvinfo.AGVNUM);//实时检查AGV所在的地标和路线是否处于平行的时候
  956. agvinfo.Direction = CheckDirectionFlag(agvinfo.MARKNUM, agvinfo.ROUTENUM, agvinfo.AGVNUM);//实时检查AGV所在路线上的放向
  957. if (agvinfo.TrafficFlag)
  958. {
  959. bool falg1 = false;
  960. bool falg2 = false;
  961. int indexrow = 0;
  962. for (int j = 0; j < agvinfo.TRAFFICNUM.Count; j++)
  963. {
  964. if (agvinfo.TRAFFICNUM[j].MainAgv != null)//如果等零的话
  965. {
  966. if (agvinfo.TRAFFICNUM[j].MainAgv != agvinfo)
  967. {
  968. if (agvinfo.ParallelFlag && agvinfo.TRAFFICNUM[j].MainAgv.ParallelFlag)
  969. {
  970. falg1 = true;
  971. }
  972. else
  973. {
  974. falg1 = false;
  975. break;
  976. }
  977. }
  978. }
  979. }
  980. for (int j = 0; j < agvinfo.TRAFFICNUM.Count; j++)
  981. {
  982. if (agvinfo.TRAFFICNUM[j].MainAgv != null)//如果等零的话
  983. {
  984. if (agvinfo.TRAFFICNUM[j].MainAgv != agvinfo)
  985. {
  986. for (int i = 0; i < agvinfo.Direction.Count; i++)
  987. {
  988. if (agvinfo.TRAFFICNUM[j].MainAgv.Direction.Contains(agvinfo.Direction[i]))//方向相同则放行
  989. {
  990. falg2 = true;
  991. break;
  992. }
  993. else
  994. {
  995. falg2 = false;
  996. }
  997. }
  998. }
  999. }
  1000. }
  1001. if (falg1 && falg2)//只有是平行线且方向一致时才不管制
  1002. {
  1003. agvinfo.TrafficFlag = false;
  1004. for (int i = 0; i < agvinfo.TRAFFICNUM.Count; i++)
  1005. {
  1006. if (agvinfo.TRAFFICNUM[i].listAgvQueue.Contains(agvinfo))
  1007. {
  1008. agvinfo.TRAFFICNUM[i].listAgvQueue.Remove(agvinfo);
  1009. agvinfo.TRAFFICNUM[i].listAgvQueue.Insert(0, agvinfo);//把放行的agv排到队列前面
  1010. }
  1011. }
  1012. }
  1013. }
  1014. }
  1015. #endregion
  1016. }
  1017. }
  1018. }
  1019. /// <summary>
  1020. /// 获取agv管制状态
  1021. /// </summary>
  1022. /// <summary>
  1023. /// 检查管制区数据是否变化
  1024. /// </summary>
  1025. /// <param name="list"></param>
  1026. /// <param name="newTrafficList"></param>
  1027. /// <returns></returns>
  1028. private bool CheckChange(List<TrafficAreaModel> list, List<TrafficAreaModel> newTrafficList)
  1029. {
  1030. if (list.Count != newTrafficList.Count)
  1031. {
  1032. return true;
  1033. }
  1034. else
  1035. {
  1036. if (list.Count == 0)
  1037. {
  1038. return true;
  1039. }
  1040. else
  1041. {
  1042. foreach (TrafficAreaModel tam in newTrafficList)
  1043. {
  1044. if (!list.Contains(tam))
  1045. {
  1046. return true;
  1047. }
  1048. // break;
  1049. }
  1050. }
  1051. }
  1052. return false;
  1053. }
  1054. /// <summary>
  1055. /// 检查路线是否平行
  1056. /// </summary>
  1057. /// <returns></returns>
  1058. private bool CheckRouteFlag(int mark, int route, int agvnum)
  1059. {
  1060. DAL.ZSql sql1 = new DAL.ZSql();
  1061. int trafficnum = 0;
  1062. string a = "select DISTINCT Parallel from T_Line where LineNum=" + route + "and MarkID=(select ID from T_Mark where Mark=" + mark + "and WorkLine=(select WorkLine from T_WorkLine where CarID=" + agvnum + ")) ";
  1063. sql1.Open(a);
  1064. if (sql1.Rows.Count > 0)
  1065. {
  1066. trafficnum = Convert.ToInt32(sql1.m_table.Rows[0]["Parallel"]);
  1067. }
  1068. if (trafficnum == 1)
  1069. {
  1070. return true;
  1071. }
  1072. else
  1073. {
  1074. return false;
  1075. }
  1076. }
  1077. /// <summary>
  1078. /// 检查路线是否平行
  1079. /// </summary>
  1080. /// <returns></returns>
  1081. private List<int> CheckDirectionFlag(int mark, int route, int agvnum)
  1082. {
  1083. List<int> Directionlist = new List<int>();
  1084. DAL.ZSql sql1 = new DAL.ZSql();
  1085. int trafficnum = -1;
  1086. string a = "select DISTINCT Direction from T_Line where LineNum=" + route + "and MarkID=(select ID from T_Mark where Mark=" + mark + "and WorkLine=(select WorkLine from T_WorkLine where CarID=" + agvnum + ") )";
  1087. sql1.Open(a);
  1088. if (sql1.Rows.Count > 0)
  1089. {
  1090. for (int i = 0; i < sql1.m_table.Rows.Count; i++)
  1091. {
  1092. if (!string.IsNullOrEmpty(sql1.m_table.Rows[i]["Direction"].ToString()))
  1093. {
  1094. trafficnum = Convert.ToInt32(sql1.m_table.Rows[i]["Direction"]);
  1095. Directionlist.Add(trafficnum);
  1096. }
  1097. }
  1098. }
  1099. return Directionlist;
  1100. }
  1101. #endregion
  1102. #region 功能性函数
  1103. #region 把byte字符串转化成为AGVInfo对象(废弃)
  1104. /// <summary>
  1105. /// 把byte字符串转化成为AGVInfo对象
  1106. /// </summary>
  1107. /// <param name="tempBuffer"></param>
  1108. /// <returns></returns>
  1109. //public static AGVInfoModel ToAgvInfo(byte[] tempBuffer)
  1110. //{
  1111. // AGVInfoModel agvinfo = new AGVInfoModel();
  1112. // if (DataHandle.DataCheck(tempBuffer) == 0)
  1113. // {
  1114. // agvinfo.AGVNUM = tempBuffer[2];
  1115. // //agvinfo.AGVNAME = "";
  1116. // agvinfo.MARKNUM = tempBuffer[3];
  1117. // agvinfo.MARKFUN = tempBuffer[4].ToString();
  1118. // agvinfo.RUNSTATUS = tempBuffer[5];
  1119. // switch (tempBuffer[5])
  1120. // {
  1121. // #region 异常分类
  1122. // case 1:
  1123. // agvinfo.ALARMCODE = 1;
  1124. // agvinfo.ALARMINFO = "无异常";
  1125. // break;
  1126. // case 2:
  1127. // agvinfo.ALARMCODE = 2;
  1128. // agvinfo.ALARMINFO = "急停报警";
  1129. // break;
  1130. // case 3:
  1131. // agvinfo.ALARMCODE = 3;
  1132. // agvinfo.ALARMINFO = "防撞报警";
  1133. // break;
  1134. // case 4:
  1135. // agvinfo.ALARMCODE = 4;
  1136. // agvinfo.ALARMINFO = "牵引棒报警";
  1137. // break;
  1138. // case 5:
  1139. // agvinfo.ALARMCODE = 5;
  1140. // agvinfo.ALARMINFO = "障碍物";
  1141. // break;
  1142. // case 6:
  1143. // agvinfo.ALARMCODE = 6;
  1144. // agvinfo.ALARMINFO = "跑错路线";
  1145. // break;
  1146. // case 7:
  1147. // agvinfo.ALARMCODE = 7;
  1148. // agvinfo.ALARMINFO = "电压报警";
  1149. // break;
  1150. // case 8:
  1151. // agvinfo.ALARMCODE = 8;
  1152. // agvinfo.ALARMINFO = "脱轨报警";
  1153. // break;
  1154. // case 9:
  1155. // agvinfo.ALARMCODE = 9;
  1156. // agvinfo.ALARMINFO = "低电压报警";
  1157. // break;
  1158. // case 10:
  1159. // agvinfo.ALARMCODE = 10;
  1160. // agvinfo.ALARMINFO = "低电压停机";
  1161. // break;
  1162. // case 11:
  1163. // agvinfo.ALARMCODE = 11;
  1164. // agvinfo.ALARMINFO = "超载报警";
  1165. // break;
  1166. // default:
  1167. // agvinfo.ALARMCODE = -1;
  1168. // agvinfo.ALARMINFO = "未知异常";
  1169. // break;
  1170. // #endregion
  1171. // }
  1172. // agvinfo.ROUTENUM = tempBuffer[6];
  1173. // agvinfo.SPEEDLEVEL = tempBuffer[7];
  1174. // #region 电池信息
  1175. // //agvinfo.batteryDatas.Add(tempBuffer[8].ToString());
  1176. // //agvinfo.batteryDatas.Add(tempBuffer[9].ToString());
  1177. // //agvinfo.batteryDatas.Add(tempBuffer[10].ToString());
  1178. // //agvinfo.batteryDatas.Add(tempBuffer[11].ToString());
  1179. // //agvinfo.batteryDatas.Add(tempBuffer[12].ToString());
  1180. // //agvinfo.batteryDatas.Add(tempBuffer[13].ToString());
  1181. // #endregion
  1182. // }
  1183. // return agvinfo;
  1184. //}
  1185. #endregion
  1186. /// <summary>
  1187. /// 存放字节数组的list
  1188. /// </summary>
  1189. public static List<byte[]> list = new List<byte[]>();
  1190. /// <summary>
  1191. /// 把字节数组中有效的协议数组拆分下来
  1192. /// </summary>
  1193. /// <param name="buffer"></param>
  1194. public static void byteList(byte[] buffer)
  1195. {
  1196. #region 数据解析,拆分有用的字节数组
  1197. if (buffer.Length == 10)
  1198. {
  1199. if (buffer[0] == 0x10)
  1200. {
  1201. if (buffer[9] == 0x03 && buffer[8] == XOR_Check(buffer, 0, 8))
  1202. {
  1203. list.Add(buffer);
  1204. }
  1205. }
  1206. }
  1207. else if (buffer.Length > 10)
  1208. {
  1209. if (buffer[0] == 0x10)
  1210. {
  1211. if (buffer[9] == 0x03 && buffer[8] == XOR_Check(buffer, 0, 8))
  1212. {
  1213. byte[] temp = new byte[10];
  1214. byte[] last = new byte[buffer.Length - 10];
  1215. buffer.CopyTo(temp, 0);
  1216. buffer.CopyTo(last, 0);
  1217. list.Add(temp);
  1218. byteList(last);
  1219. }
  1220. }
  1221. }
  1222. #endregion
  1223. }
  1224. /// <summary>
  1225. /// 取异或校验码
  1226. /// </summary>
  1227. /// <param name="buf"></param>
  1228. /// <param name="index"></param>
  1229. /// <param name="length"></param>
  1230. /// <returns></returns>
  1231. public static byte XOR_Check(byte[] buf, int index, int length)
  1232. {
  1233. byte bcc = 0;
  1234. if (index > length)
  1235. return 0;
  1236. for (int i = index; i < length; i++)
  1237. {
  1238. bcc ^= buf[i];
  1239. }
  1240. return Convert.ToByte(bcc);
  1241. }
  1242. #endregion
  1243. #region 管制逻辑
  1244. public bool RequestTrafficState(AGVInfoModel agv, TrafficAreaModel traffic)
  1245. {
  1246. int lastTrafficNum = agv.TRAFFICNUM.Count();
  1247. int currentTrafficNum;
  1248. bool AgvtrafficFlag = false;
  1249. if (traffic != null)
  1250. {
  1251. currentTrafficNum = traffic.TrafficNum;
  1252. }
  1253. else
  1254. {
  1255. currentTrafficNum = 0;
  1256. }
  1257. if (lastTrafficNum == 0 && currentTrafficNum != 0)
  1258. {
  1259. #region agv从管制区外进入管制区内
  1260. return InTraffic(traffic, agv);//AGV加入管制区
  1261. #endregion
  1262. }
  1263. else if (lastTrafficNum != 0 && currentTrafficNum == 0)
  1264. {
  1265. #region agv从管制区内驶出管制区外
  1266. if (OutTraffic(lastTrafficNum, agv))
  1267. {
  1268. return AgvtrafficFlag = false;
  1269. }
  1270. #endregion
  1271. }
  1272. else if (lastTrafficNum != 0 && currentTrafficNum != 0 && lastTrafficNum != currentTrafficNum)
  1273. {
  1274. #region 从管制区A进入管制区B
  1275. if (OutTraffic(lastTrafficNum, agv))
  1276. {
  1277. //trafficAgvNum = traffic.MainAgv;
  1278. return InTraffic(traffic, agv);
  1279. }
  1280. #endregion
  1281. }
  1282. else
  1283. {
  1284. //未知情况
  1285. }
  1286. return AgvtrafficFlag;
  1287. }
  1288. public bool OutTraffic(int trafficNum, AGVInfoModel agv)
  1289. {
  1290. if (agv == null)
  1291. {
  1292. return false;
  1293. }
  1294. if (GlobalPara.TrafficBuffer.Keys.Contains(trafficNum))
  1295. {
  1296. TrafficAreaModel outttraffic = GlobalPara.TrafficBuffer[trafficNum];
  1297. //if (lasttraffic != null)
  1298. {
  1299. //把我从就管制区的agv列表中删除
  1300. if (GlobalPara.TrafficBuffer[trafficNum].listAgvQueue.Contains(agv))
  1301. {
  1302. GlobalPara.TrafficBuffer[trafficNum].listAgvQueue.Remove(agv);
  1303. }
  1304. //我是旧管制区的主机,更新旧管制区数据
  1305. if (GlobalPara.TrafficBuffer[trafficNum].MainAgv == agv)
  1306. {
  1307. if (GlobalPara.TrafficBuffer[trafficNum].listAgvQueue.Count > 0)
  1308. {
  1309. GlobalPara.TrafficBuffer[trafficNum].MainAgv = GlobalPara.TrafficBuffer[trafficNum].listAgvQueue[0];
  1310. GlobalPara.TrafficBuffer[trafficNum].IsTraffic = true;
  1311. AGVInfoModel newMainAgv = GlobalPara.TrafficBuffer[trafficNum].MainAgv;
  1312. newMainAgv.TRAFFICAGV = null;
  1313. newMainAgv.TrafficFlag = false;
  1314. }
  1315. else
  1316. {
  1317. GlobalPara.TrafficBuffer[trafficNum].IsTraffic = false;
  1318. GlobalPara.TrafficBuffer[trafficNum].MainAgv = null;
  1319. }
  1320. }
  1321. if (agv.TRAFFICNUM.Contains(outttraffic))
  1322. {
  1323. agv.TRAFFICNUM.Remove(outttraffic);//更新agv管制区编号
  1324. }
  1325. agv.TrafficFlag = false;
  1326. agv.TRAFFICAGV = null;
  1327. return true;
  1328. }
  1329. }
  1330. return false;
  1331. }
  1332. public bool InTraffic(TrafficAreaModel traffic, AGVInfoModel agv)
  1333. {
  1334. if (traffic != null && agv != null)
  1335. {
  1336. //加入管制区agv列表
  1337. if (!traffic.listAgvQueue.Contains(agv))
  1338. {
  1339. traffic.listAgvQueue.Add(agv);
  1340. }
  1341. //判断管制区是否有主机
  1342. if (traffic.MainAgv == null)
  1343. {
  1344. //把队列中的第一位变成agv
  1345. traffic.MainAgv = traffic.listAgvQueue[0];
  1346. //检查管制区管制状态
  1347. if (!traffic.IsTraffic)
  1348. {
  1349. traffic.IsTraffic = true;
  1350. }
  1351. }
  1352. else
  1353. {
  1354. //判断我是不是主机
  1355. if (traffic.MainAgv != agv)
  1356. {
  1357. //非主机:返回管制状态为true,管制agv为管制区主机agv编号
  1358. agv.TRAFFICAGV = traffic.MainAgv;
  1359. agv.TrafficFlag = true;
  1360. return true;
  1361. }
  1362. else
  1363. {
  1364. //是主机:管制状态为false,管制agv为0
  1365. agv.TRAFFICAGV = null;
  1366. agv.TrafficFlag = false;
  1367. return false;
  1368. }
  1369. }
  1370. }
  1371. return agv.TrafficFlag;
  1372. }
  1373. public bool InTraffic(int trafficNum, AGVInfoModel agv)
  1374. {
  1375. if (GlobalPara.TrafficBuffer.Keys.Contains(trafficNum))
  1376. {
  1377. TrafficAreaModel newtraffic = GlobalPara.TrafficBuffer[trafficNum];
  1378. if (newtraffic != null)
  1379. {
  1380. //agv.TRAFFICNUM = newtraffic.TrafficNum;//更新agv管制区编号
  1381. //加入管制区agv列表
  1382. if (!newtraffic.listAgvQueue.Contains(agv))
  1383. {
  1384. newtraffic.listAgvQueue.Add(agv);
  1385. }
  1386. //判断管制区是否有主机
  1387. if (newtraffic.MainAgv == null)
  1388. {
  1389. //把队列中的第一位变成agv
  1390. newtraffic.MainAgv = newtraffic.listAgvQueue[0];
  1391. //检查管制区管制状态
  1392. if (!newtraffic.IsTraffic)
  1393. {
  1394. newtraffic.IsTraffic = true;
  1395. }
  1396. }
  1397. else
  1398. {
  1399. //判断我是不是主机
  1400. if (newtraffic.MainAgv != agv)
  1401. {
  1402. //非主机:返回管制状态为true,管制agv为管制区主机agv编号
  1403. agv.TRAFFICAGV = newtraffic.MainAgv;
  1404. agv.TrafficFlag = true;
  1405. }
  1406. else
  1407. {
  1408. //是主机:管制状态为false,管制agv为0
  1409. agv.TRAFFICAGV = null;
  1410. agv.TrafficFlag = false;
  1411. }
  1412. }
  1413. return true;
  1414. }
  1415. }
  1416. return false;
  1417. }
  1418. #endregion
  1419. public void Dispose()
  1420. {
  1421. //throw new NotImplementedException();
  1422. }
  1423. private static void ArrangeBuffer(List<byte> bufferList, byte targetByte)
  1424. {
  1425. int delBytes = 1;
  1426. for (int i = 1; i < bufferList.Count; i++)
  1427. {
  1428. if (bufferList[i] == targetByte)
  1429. {
  1430. break;
  1431. }
  1432. else
  1433. {
  1434. delBytes++;
  1435. }
  1436. }
  1437. try
  1438. {
  1439. lock (portLock)
  1440. {
  1441. bufferList.RemoveRange(0, delBytes);
  1442. }
  1443. }
  1444. catch (Exception ex)
  1445. {
  1446. //MessageBox.Show(ex.Message);
  1447. }
  1448. }
  1449. private static object portLock = new object();
  1450. public void UpdateBuffer(List<byte> receiveBuffer)
  1451. {
  1452. List<byte> frameFuncList = new List<byte> { 0x41, 0x42, 0x46, 0x32, 0x33, 0x35, 0x38 };
  1453. while (receiveBuffer.Count >= 10)
  1454. {
  1455. byte frameHead = 0x10; // 帧头
  1456. byte frameTaig = 0x03;
  1457. if ((receiveBuffer[0] == frameHead) && (receiveBuffer.Count >= 14) && frameFuncList.Contains(receiveBuffer[1]))
  1458. {
  1459. byte checkSum = 0x00;
  1460. for (int i = 0; i < 12; i++)
  1461. {
  1462. checkSum ^= receiveBuffer[i];
  1463. }
  1464. if (checkSum == receiveBuffer[12] && frameTaig == receiveBuffer[13])
  1465. {
  1466. byte[] data = new byte[14];
  1467. for (int i = 0; i < 14; i++)
  1468. {
  1469. data[i] = receiveBuffer[i];
  1470. }
  1471. lock (portLock)
  1472. {
  1473. receiveBuffer.RemoveRange(0, 14);
  1474. }
  1475. //data丢到调度板块去处理
  1476. GlobalPara.dispatchList.Add(data);
  1477. }
  1478. else
  1479. {
  1480. ArrangeBuffer(receiveBuffer, frameHead);
  1481. }
  1482. }
  1483. else if ((receiveBuffer[0] == frameHead) && (receiveBuffer.Count >= 12) && receiveBuffer[1] == 0x64)
  1484. {
  1485. byte checkSum = 0x00;
  1486. for (int i = 0; i < 10; i++)
  1487. {
  1488. checkSum ^= receiveBuffer[i];
  1489. }
  1490. if (checkSum == receiveBuffer[10] && frameTaig == receiveBuffer[11])
  1491. {
  1492. byte[] agvdata = new byte[12];
  1493. for (int i = 0; i < 12; i++)
  1494. {
  1495. agvdata[i] = receiveBuffer[i];
  1496. }
  1497. lock (portLock)
  1498. {
  1499. receiveBuffer.RemoveRange(0, 12);
  1500. }
  1501. //解析新协议
  1502. int agvnum = agvdata[2];
  1503. if (GlobalPara.AgvInfoDic.ContainsKey(agvnum))
  1504. {
  1505. #region 属性更新
  1506. AGVInfoModel agvinfo = GlobalPara.AgvInfoDic[agvnum];
  1507. agvinfo.AGVNUM = agvnum;
  1508. agvinfo.MARKNUM = Convert.ToInt32(agvdata[4] | ((agvdata[3] & 0x1F) ));
  1509. agvinfo.ROUTENUM = Convert.ToInt32(agvdata[9] | ((agvdata[8] & 0x1F) ));
  1510. if (agvdata[5] > 0 && agvdata[5] < 32)
  1511. {
  1512. agvinfo.MARKFUN = agvdata[5];
  1513. }
  1514. agvinfo.FPS = (int)((agvdata[3] & 0xE0) >> 5);
  1515. if (agvinfo.FPS == 1)
  1516. {
  1517. agvinfo.RUNSTATUS_Cur = agvinfo.RUNSTATUS = (((agvdata[8] & 0xE0) >> 5) + 0x40);
  1518. //报警信息处理
  1519. switch (agvdata[6] + 1)
  1520. {
  1521. #region 异常分类
  1522. case 1:
  1523. agvinfo.ALARMCODE = "1";
  1524. agvinfo.ALARMINFO = "无异常";
  1525. break;
  1526. case 2:
  1527. agvinfo.ALARMCODE = "2";
  1528. agvinfo.ALARMINFO = "急停报警";
  1529. break;
  1530. case 3:
  1531. agvinfo.ALARMCODE = "3";
  1532. agvinfo.ALARMINFO = "防撞报警";
  1533. break;
  1534. case 4:
  1535. agvinfo.ALARMCODE = "4";
  1536. agvinfo.ALARMINFO = "牵引棒报警";
  1537. break;
  1538. case 5:
  1539. agvinfo.ALARMCODE = "5";
  1540. agvinfo.ALARMINFO = "障碍物";
  1541. break;
  1542. case 6:
  1543. agvinfo.ALARMCODE = "6";
  1544. agvinfo.ALARMINFO = "路线异常";
  1545. break;
  1546. case 7:
  1547. agvinfo.ALARMCODE = "7";
  1548. agvinfo.ALARMINFO = "电压异常";
  1549. break;
  1550. case 8:
  1551. agvinfo.ALARMCODE = "8";
  1552. agvinfo.ALARMINFO = "脱轨报警";
  1553. break;
  1554. case 9:
  1555. agvinfo.ALARMCODE = "9";
  1556. agvinfo.ALARMINFO = "低电压报警";
  1557. break;
  1558. case 10:
  1559. agvinfo.ALARMCODE = "10";
  1560. agvinfo.ALARMINFO = "低电压停机";
  1561. break;
  1562. case 11:
  1563. agvinfo.ALARMCODE = "11";
  1564. agvinfo.ALARMINFO = "超载报警";
  1565. break;
  1566. default:
  1567. agvinfo.ALARMCODE = "256";
  1568. agvinfo.ALARMINFO = "未知异常";
  1569. break;
  1570. #endregion
  1571. }
  1572. if (agvdata[6] != 0)
  1573. {
  1574. agvinfo.RUNSTATUS = int.Parse(agvinfo.ALARMCODE) - 1;
  1575. }
  1576. //速度等级
  1577. int SpeedGrade = (int)agvdata[7];
  1578. if (SpeedGrade > 0 && SpeedGrade < 6)
  1579. {
  1580. agvinfo.SPEEDLEVEL = SpeedGrade;
  1581. }
  1582. Analyze(agvinfo);
  1583. }
  1584. else if(agvinfo.FPS==2)
  1585. {
  1586. int BatteryEleInt = (int)(agvdata[5] << 8 | agvdata[6]);
  1587. // int BatteryEleDecimal = (int)agvdata[5];
  1588. int BatteryPowInt = (int)agvdata[7];
  1589. if (((decimal)BatteryEleInt) / 100 <= 200)
  1590. {
  1591. agvinfo.Battery_Electricity = ((decimal)BatteryEleInt) / 100;
  1592. }
  1593. agvinfo.Battery_Power = (decimal)BatteryPowInt;
  1594. }
  1595. else if (agvinfo.FPS == 3)
  1596. {
  1597. int BatteryVolInt = (int)((agvdata[5] << 4) | (agvdata[6]>>4));
  1598. agvinfo.Bttery_Voltage = ((decimal)BatteryVolInt)/100;
  1599. int BatteryTemInt = (int)(((agvdata[6]&0x0F) << 8) | (agvdata[7]));
  1600. agvinfo.Battery_Temperature = ((decimal)BatteryTemInt) / 100;
  1601. }
  1602. agvinfo.OffLineCount = 0;
  1603. agvinfo.ConnectStatus = true;
  1604. #endregion
  1605. }
  1606. }
  1607. else
  1608. {
  1609. ArrangeBuffer(receiveBuffer, frameHead);
  1610. }
  1611. }
  1612. else if ((receiveBuffer[0] == frameHead) && (receiveBuffer.Count >= 10) && receiveBuffer[1] == 0x62)
  1613. {
  1614. byte checkSum = 0x00;
  1615. for (int i = 0; i < 8; i++)
  1616. {
  1617. checkSum ^= receiveBuffer[i];
  1618. }
  1619. if (checkSum == receiveBuffer[8] && frameTaig == receiveBuffer[9])
  1620. {
  1621. byte[] agvdata = new byte[10];
  1622. for (int i = 0; i < 10; i++)
  1623. {
  1624. agvdata[i] = receiveBuffer[i];
  1625. }
  1626. lock (portLock)
  1627. {
  1628. receiveBuffer.RemoveRange(0, 10);
  1629. }
  1630. //解析旧协议
  1631. int agvnum = agvdata[2];
  1632. if (GlobalPara.AgvInfoDic.ContainsKey(agvnum))
  1633. {
  1634. #region 属性更新
  1635. AGVInfoModel agvinfo = GlobalPara.AgvInfoDic[agvnum];
  1636. agvinfo.AGVNUM = agvnum;
  1637. agvinfo.MARKNUM = Convert.ToInt16(agvdata[3] | ((agvdata[7] & 0xC0) << 2));
  1638. agvinfo.ROUTENUM = agvdata[6];
  1639. if (agvdata[4] > 0 && agvdata[4] < 32)
  1640. {
  1641. agvinfo.MARKFUN = agvdata[4];
  1642. }
  1643. agvinfo.RUNSTATUS = agvdata[5];
  1644. //报警信息处理
  1645. switch (agvdata[5])
  1646. {
  1647. #region 异常分类
  1648. case 1:
  1649. agvinfo.ALARMCODE = "1";
  1650. agvinfo.ALARMINFO = "无异常";
  1651. break;
  1652. case 2:
  1653. agvinfo.ALARMCODE = "2";
  1654. agvinfo.ALARMINFO = "急停报警";
  1655. break;
  1656. case 3:
  1657. agvinfo.ALARMCODE = "3";
  1658. agvinfo.ALARMINFO = "防撞报警";
  1659. break;
  1660. case 4:
  1661. agvinfo.ALARMCODE = "4";
  1662. agvinfo.ALARMINFO = "牵引棒报警";
  1663. break;
  1664. case 5:
  1665. agvinfo.ALARMCODE = "5";
  1666. agvinfo.ALARMINFO = "障碍物";
  1667. break;
  1668. case 6:
  1669. agvinfo.ALARMCODE = "6";
  1670. agvinfo.ALARMINFO = "跑错路线";
  1671. break;
  1672. case 7:
  1673. agvinfo.ALARMCODE = "7";
  1674. agvinfo.ALARMINFO = "电压报警";
  1675. break;
  1676. case 8:
  1677. agvinfo.ALARMCODE = "8";
  1678. agvinfo.ALARMINFO = "脱轨报警";
  1679. break;
  1680. case 9:
  1681. agvinfo.ALARMCODE = "9";
  1682. agvinfo.ALARMINFO = "低电压报警";
  1683. break;
  1684. case 10:
  1685. agvinfo.ALARMCODE = "10";
  1686. agvinfo.ALARMINFO = "低电压停机";
  1687. break;
  1688. case 11:
  1689. agvinfo.ALARMCODE = "11";
  1690. agvinfo.ALARMINFO = "超载报警";
  1691. break;
  1692. default:
  1693. agvinfo.ALARMCODE = "-1";
  1694. agvinfo.ALARMINFO = "未知异常";
  1695. break;
  1696. #endregion
  1697. }
  1698. //速度等级
  1699. int SpeedGrade = agvdata[7] & 0x3F;
  1700. if (SpeedGrade > 0 && SpeedGrade < 6)
  1701. {
  1702. agvinfo.SPEEDLEVEL = SpeedGrade;
  1703. }
  1704. agvinfo.OffLineCount = 0;
  1705. agvinfo.ConnectStatus = true;
  1706. Analyze(agvinfo);
  1707. #endregion
  1708. }
  1709. }
  1710. else
  1711. {
  1712. ArrangeBuffer(receiveBuffer, frameHead);
  1713. }
  1714. }
  1715. else
  1716. {
  1717. ArrangeBuffer(receiveBuffer, frameHead);
  1718. }
  1719. }
  1720. }
  1721. public void Analyze(AGVInfoModel agvinfo)
  1722. {
  1723. string a = "";
  1724. // if (agvdata.Count >= 10)
  1725. {
  1726. #region 管制区逻辑处理部分
  1727. TrafficAreaService trafficService = new TrafficAreaService();
  1728. //前管制区号
  1729. //拷贝一份另存为
  1730. if (agvinfo.PTRAFFICNUM != agvinfo.TRAFFICNUM)
  1731. {
  1732. agvinfo.PTRAFFICNUM.Clear();
  1733. agvinfo.PTRAFFICNUM.AddRange(agvinfo.TRAFFICNUM);
  1734. }
  1735. //最新管制区号
  1736. //获取当前地标位置是否在管制区内
  1737. List<TrafficAreaModel> newTrafficList = trafficService.GetTrafficList(agvinfo.MARKNUM, agvinfo.ROUTENUM, agvinfo.AGVNUM);
  1738. List<TrafficAreaModel> outTrafficList = new List<TrafficAreaModel>();
  1739. outTrafficList.AddRange(agvinfo.PTRAFFICNUM);
  1740. bool isChange = CheckChange(agvinfo.TRAFFICNUM, newTrafficList);
  1741. //检查旧管制区与新管制区是否有变化,有变化才需要检查AGV的管制状态的逻辑变化。
  1742. if (isChange)
  1743. {
  1744. #region 管制区数据更新
  1745. if (newTrafficList.Count > 0)
  1746. {
  1747. #region 标明进入了管制区(交叉管制区或独立管制区)
  1748. {
  1749. foreach (TrafficAreaModel traffic in newTrafficList)
  1750. {
  1751. //添加AGV的管制区对象列表
  1752. if (!agvinfo.TRAFFICNUM.Contains(traffic))
  1753. {
  1754. //添加最新的管制区
  1755. agvinfo.TRAFFICNUM.Add(traffic);
  1756. //管制区有AGV进入
  1757. traffic.AGVINTER(agvinfo, false);
  1758. }
  1759. if (outTrafficList.Contains(traffic))
  1760. {
  1761. outTrafficList.Remove(traffic);
  1762. }
  1763. }
  1764. }
  1765. //循环把AGV已经退出的管制区给处理一下。
  1766. foreach (TrafficAreaModel traffic in outTrafficList)
  1767. {
  1768. //管制区有AGV离开
  1769. agvinfo.TRAFFICNUM.Remove(traffic);
  1770. traffic.AGVLEAVE(agvinfo);
  1771. if (traffic.listAgvQueue.Count > 0)
  1772. {
  1773. traffic.ReleaseAgv(); //调用放行事件
  1774. }
  1775. }
  1776. #endregion
  1777. }
  1778. else
  1779. {
  1780. #region 表示AGV现在不在任何管制区
  1781. foreach (TrafficAreaModel traffic in outTrafficList)
  1782. {
  1783. agvinfo.TRAFFICNUM.Remove(traffic);
  1784. traffic.AGVLEAVE(agvinfo);
  1785. if (traffic.listAgvQueue.Count > 0)
  1786. {
  1787. traffic.ReleaseAgv(); //调用放行事件
  1788. }
  1789. }
  1790. if (agvinfo.TrafficFlag)
  1791. {
  1792. agvinfo.TrafficFlag = false;
  1793. agvinfo.TRAFFICAGV = null;
  1794. }
  1795. #endregion
  1796. }
  1797. #endregion
  1798. #region 管制区的数据更新后,判定AGV的管制状态
  1799. //AGV只有在所有管制区成为主机的情况下,才能不被管制
  1800. bool isTraffic = false;//标识AGV是否应该被管制,true表示应该不管制;false表示不应该不管制
  1801. //int agv=0;
  1802. #region 遍历AGV现在的管制区,寻找是否有某个管制区还管制着本AGV(我自己)
  1803. foreach (var traffic in agvinfo.TRAFFICNUM)
  1804. {
  1805. //一旦发现AGV在某个管制区还不是主机,则把AGV管制住
  1806. if (agvinfo != traffic.MainAgv)
  1807. {
  1808. if (traffic.listAgvQueue.Contains(traffic.MainAgv))
  1809. {
  1810. traffic.MainAgv = agvinfo;
  1811. agvinfo.TrafficFlag = false;
  1812. isTraffic = false;
  1813. break;
  1814. }
  1815. else
  1816. {
  1817. isTraffic = true;
  1818. agvinfo.TRAFFICAGV = traffic.MainAgv;//---LG修改方便查看主机
  1819. break;
  1820. }
  1821. }
  1822. }
  1823. #endregion
  1824. #region 发现AGV需要被管制
  1825. if (isTraffic)
  1826. {
  1827. agvinfo.TrafficFlag = true;
  1828. }
  1829. else
  1830. {
  1831. agvinfo.TrafficFlag = false;
  1832. agvinfo.TRAFFICAGV = null;
  1833. foreach (var traffic in outTrafficList)
  1834. {
  1835. if (traffic.MainAgv != null)
  1836. {
  1837. traffic.ReleaseMainAgv();
  1838. }
  1839. else
  1840. {
  1841. if (traffic.listAgvQueue.Count > 0)
  1842. {
  1843. traffic.ReleaseAgv(traffic.listAgvQueue[0]);
  1844. }
  1845. }
  1846. }
  1847. }
  1848. #endregion
  1849. #endregion
  1850. #region 管制区数据更新日志记录
  1851. //StringBuilder a1 = new StringBuilder();
  1852. //foreach (var n in agvinfo.TRAFFICNUM)
  1853. //{
  1854. // a1.Append("->"+n.TrafficNum);
  1855. //}
  1856. //if (a1.Length > 1)
  1857. //{
  1858. // a1.Remove(0, 2);
  1859. // a1.Append("|");
  1860. //}
  1861. //else
  1862. //{
  1863. // a1.Append("无");
  1864. //}
  1865. //string marktime = DateTime.Now.ToString("HH:mm:ss");
  1866. //a = string.Format("{5} : AGV编号:{0} --AGV管制状态:{1} --当前地标:{2} --当前路线:{3} --当前管制区:{4} --当前AGV管制区主机:{6}", agvinfo.AGVNUM, agvinfo.TrafficFlag, agvinfo.MARKNUM, agvinfo.ROUTENUM, a1, marktime,agvinfo.TRAFFICAGV);
  1867. //ErrorLog.WriteErrorLogagv(a);
  1868. #endregion
  1869. }
  1870. #endregion
  1871. #region 罗国--预防管制区只有一辆车还被管制住。
  1872. bool SigleFlag = false;
  1873. bool SigleFlag1 = false;
  1874. if (agvinfo.TrafficFlag)
  1875. {
  1876. foreach (var agvtrffic in agvinfo.TRAFFICNUM)
  1877. {
  1878. if (agvinfo.TRAFFICAGV == null)//没有主机的时候不放行
  1879. {
  1880. if (agvtrffic.listAgvQueue.Count == 0)
  1881. {
  1882. SigleFlag = true;
  1883. }
  1884. else if (agvtrffic.listAgvQueue.Count == 1)
  1885. {
  1886. if (agvtrffic.listAgvQueue[0] == agvinfo)
  1887. {
  1888. SigleFlag = true;
  1889. }
  1890. }
  1891. else
  1892. {
  1893. SigleFlag = false;
  1894. break;
  1895. }
  1896. }
  1897. else//有主机不放行
  1898. {
  1899. foreach (var agvtraffic1 in agvinfo.TRAFFICAGV.TRAFFICNUM)
  1900. {
  1901. if (agvtraffic1 == agvtrffic)//有相同的区域
  1902. {
  1903. SigleFlag1 = false;
  1904. break;
  1905. }
  1906. else
  1907. {
  1908. SigleFlag1 = true;
  1909. }
  1910. }
  1911. if (!SigleFlag1)
  1912. {
  1913. break;
  1914. }
  1915. }
  1916. }
  1917. if (SigleFlag)//确定只有一台AGV把AGV
  1918. {
  1919. agvinfo.TrafficFlag = false;
  1920. foreach (var traffic1 in agvinfo.TRAFFICNUM)//清空队列中所有的AGV
  1921. {
  1922. traffic1.MainAgv = agvinfo;
  1923. if (traffic1.listAgvQueue.Contains(agvinfo))
  1924. {
  1925. traffic1.listAgvQueue.Remove(agvinfo);
  1926. }
  1927. }
  1928. }
  1929. if (SigleFlag1)//有主机的处理,且主机不在管制区域内
  1930. {
  1931. agvinfo.TrafficFlag = false;
  1932. foreach (var traffic2 in agvinfo.TRAFFICNUM)//清空队列中AGV的主机
  1933. {
  1934. traffic2.MainAgv = agvinfo;
  1935. if (traffic2.listAgvQueue.Contains(agvinfo.TRAFFICAGV))
  1936. {
  1937. traffic2.listAgvQueue.Remove(agvinfo.TRAFFICAGV);
  1938. }
  1939. }
  1940. }
  1941. }
  1942. #endregion
  1943. #region 罗国--预防多管制区里互相管制
  1944. if (agvinfo.TrafficFlag)//在被管制的前提下
  1945. {
  1946. if (agvinfo.TRAFFICNUM.Count >= 2)//在多个管制区的互相管制随机放行
  1947. {
  1948. if (agvinfo.TRAFFICAGV.TRAFFICAGV == agvinfo)//主机的主机等于主机说明互相管制了
  1949. {
  1950. agvinfo.TrafficFlag = false;
  1951. foreach (var traffic1 in agvinfo.TRAFFICNUM)//清空队列中所有的AGV
  1952. {
  1953. traffic1.MainAgv = agvinfo;
  1954. if (traffic1.listAgvQueue.Contains(agvinfo))
  1955. {
  1956. traffic1.listAgvQueue.Remove(agvinfo);
  1957. }
  1958. if (traffic1.listAgvQueue.Contains(agvinfo.TRAFFICAGV))//把被管制的agv放在各个管制区的队列第一位
  1959. {
  1960. traffic1.listAgvQueue.Remove(agvinfo.TRAFFICAGV);
  1961. traffic1.listAgvQueue.Insert(0, agvinfo.TRAFFICAGV);
  1962. }
  1963. }
  1964. }
  1965. }
  1966. }
  1967. #endregion
  1968. #region 避免关机重启后管制状态还保留,导致放行不了
  1969. if (agvinfo.TRAFFICNUM.Count == 0)
  1970. {
  1971. agvinfo.TrafficFlag = false;
  1972. agvinfo.TRAFFICAGV = null;
  1973. }
  1974. #endregion
  1975. #region 在管制区中平行的时候就不管制了
  1976. if (GlobalPara.IsEnablePallel)
  1977. {
  1978. agvinfo.ParallelFlag = CheckRouteFlag(agvinfo.MARKNUM, agvinfo.ROUTENUM, agvinfo.AGVNUM);//实时检查AGV所在的地标和路线是否处于平行的时候
  1979. agvinfo.Direction = CheckDirectionFlag(agvinfo.MARKNUM, agvinfo.ROUTENUM, agvinfo.AGVNUM);//实时检查AGV所在路线上的放向
  1980. if (agvinfo.TrafficFlag)
  1981. {
  1982. bool falg1 = false;
  1983. bool falg2 = false;
  1984. int indexrow = 0;
  1985. for (int j = 0; j < agvinfo.TRAFFICNUM.Count; j++)
  1986. {
  1987. if (agvinfo.TRAFFICNUM[j].MainAgv != null)//如果等零的话
  1988. {
  1989. if (agvinfo.TRAFFICNUM[j].MainAgv != agvinfo)
  1990. {
  1991. if (agvinfo.ParallelFlag && agvinfo.TRAFFICNUM[j].MainAgv.ParallelFlag)
  1992. {
  1993. falg1 = true;
  1994. }
  1995. else
  1996. {
  1997. falg1 = false;
  1998. break;
  1999. }
  2000. }
  2001. }
  2002. }
  2003. for (int j = 0; j < agvinfo.TRAFFICNUM.Count; j++)
  2004. {
  2005. if (agvinfo.TRAFFICNUM[j].MainAgv != null)//如果等零的话
  2006. {
  2007. if (agvinfo.TRAFFICNUM[j].MainAgv != agvinfo)
  2008. {
  2009. for (int i = 0; i < agvinfo.Direction.Count; i++)
  2010. {
  2011. if (agvinfo.TRAFFICNUM[j].MainAgv.Direction.Contains(agvinfo.Direction[i]))//方向相同则放行
  2012. {
  2013. falg2 = true;
  2014. break;
  2015. }
  2016. else
  2017. {
  2018. falg2 = false;
  2019. }
  2020. }
  2021. }
  2022. }
  2023. }
  2024. if (falg1 && falg2)//只有是平行线且方向一致时才不管制
  2025. {
  2026. agvinfo.TrafficFlag = false;
  2027. for (int i = 0; i < agvinfo.TRAFFICNUM.Count; i++)
  2028. {
  2029. if (agvinfo.TRAFFICNUM[i].listAgvQueue.Contains(agvinfo))
  2030. {
  2031. agvinfo.TRAFFICNUM[i].listAgvQueue.Remove(agvinfo);
  2032. agvinfo.TRAFFICNUM[i].listAgvQueue.Insert(0, agvinfo);//把放行的agv排到队列前面
  2033. }
  2034. }
  2035. }
  2036. }
  2037. }
  2038. #endregion
  2039. }
  2040. }
  2041. }
  2042. }