ImportForm.cs 84 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932
  1. using System;
  2. using System.Collections.Generic;
  3. using System.ComponentModel;
  4. using System.Data;
  5. using System.Drawing;
  6. using System.IO;
  7. using System.Text;
  8. using System.Windows.Forms;
  9. using System.IO.Ports;
  10. using System.Collections;
  11. using System.Threading;
  12. using System.Text.RegularExpressions;
  13. namespace MOTINOVA_Motor_Factory_Set
  14. {
  15. public partial class ImportForm : Form
  16. {
  17. #region 文件路径
  18. string LogSaveFileName = "";
  19. string CfgFilePath = "";
  20. #endregion
  21. #region 测试参数配置
  22. //以下值在根据电机测试的配置文件中更改
  23. ushort MotorRadeSpeed = 1200; //空载转速
  24. ushort RateCadence = 100; //最高踏频
  25. ushort RateVoltage = 36000; //额定电压
  26. bool GasModeTest = true; //转把模式检测开关
  27. bool SpeedSensorTest = true; //速度传感器检测开关
  28. //以下值在软件测试文件params.cfg文件中修改
  29. ushort No_load_Current = 1000; //空载电流
  30. ushort SpeedSensorThData = 60; //车速传感器判断阈值
  31. ushort GasModeSpeed = 1200; //指拨模式测试转速
  32. #endregion
  33. #region 配置文件信息
  34. ArrayList array_CfgInfo = new ArrayList();
  35. #endregion
  36. #region 端口设置界面
  37. public static PortSettings portsettings_form = new PortSettings();
  38. #endregion
  39. #region 串口缓存
  40. public static List<byte> buffer = new List<byte>(4096);
  41. private byte[] binary_data_1 = new byte[1024];
  42. #endregion
  43. #region MC运行信息超时计数
  44. bool MC_RunInfo_Refresh = false;
  45. ushort MC_RunInfo_Refresh_Cnt = 0;
  46. #endregion
  47. #region MC故障码超时计数
  48. bool MC_ErrorCode_Refresh = false;
  49. ushort MC_ErrorCode_Refresh_Cnt = 0;
  50. #endregion
  51. #region 执行步骤
  52. public enum TestStep_Enum
  53. {
  54. Step_Init = 0,
  55. Step_SysClear = 1, //系统清除
  56. Step_Write = 2, //参数写入
  57. Step_Light = 3, //灯电压测试
  58. Step_Walk = 4, //推行测试
  59. Step_GasMode = 5, //转把测试
  60. Step_CheckVer = 6, //版本查询和确认
  61. Step_Save = 7 //数据读取和存储
  62. }
  63. TestStep_Enum TestStep;
  64. #endregion
  65. #region 反馈指令判断计时
  66. bool Ack_Flag = true;
  67. ushort Ack_Cnt = 0;
  68. #endregion
  69. #region 单步测试标志
  70. public enum StepTestResult_Enum
  71. {
  72. StepTestResult_Ready = 0,
  73. StepTestResult_Testing = 1,
  74. StepTestResult_OK = 2,
  75. StepTestResult_Fail = 3
  76. }
  77. StepTestResult_Enum StepTestFlag = StepTestResult_Enum.StepTestResult_Ready;
  78. #endregion
  79. #region 推行/转把测试计时
  80. ushort WalkProcess_Cnt = 0;
  81. ushort OK_cnt = 0;
  82. #endregion
  83. public ImportForm()
  84. {
  85. InitializeComponent();
  86. System.Windows.Forms.Control.CheckForIllegalCrossThreadCalls = false;
  87. }
  88. private void ImportForm_Load(object sender, EventArgs e)
  89. {
  90. //装载测试可用配置文件
  91. CfgFilePath = System.IO.Directory.GetCurrentDirectory() + "\\cfg\\";
  92. if (System.IO.Directory.Exists(CfgFilePath) == false)
  93. {
  94. System.IO.Directory.CreateDirectory(CfgFilePath);
  95. }
  96. var files = Directory.GetFiles(CfgFilePath, "*.ttcfg");
  97. comboBox_File.Items.Clear();
  98. foreach (var file in files)
  99. {
  100. comboBox_File.Items.Add(Path.GetFileName(file));
  101. }
  102. //装载配置参数
  103. string cfg_file = System.IO.Directory.GetCurrentDirectory() + "\\SerialNum";
  104. StreamReader objReader = new StreamReader(cfg_file);
  105. string sLine = "";
  106. ArrayList arrText = new ArrayList();//创建一个动态数组
  107. while (sLine != null)
  108. {
  109. sLine = objReader.ReadLine();
  110. arrText.Add(sLine);
  111. }
  112. objReader.Close();
  113. label_SerialNum.Text = arrText[1].ToString();//流水号
  114. }
  115. private void toolStripMenuIte_PortSet_Click(object sender, EventArgs e)
  116. {
  117. portsettings_form.Show();
  118. }
  119. #region CRC32校验
  120. static UInt32[] crc32_table = new UInt32[256]
  121. {
  122. 0x00000000, 0x04C11DB7, 0x09823B6E, 0x0D4326D9, 0x130476DC, 0x17C56B6B,
  123. 0x1A864DB2, 0x1E475005, 0x2608EDB8, 0x22C9F00F, 0x2F8AD6D6, 0x2B4BCB61,
  124. 0x350C9B64, 0x31CD86D3, 0x3C8EA00A, 0x384FBDBD, 0x4C11DB70, 0x48D0C6C7,
  125. 0x4593E01E, 0x4152FDA9, 0x5F15ADAC, 0x5BD4B01B, 0x569796C2, 0x52568B75,
  126. 0x6A1936C8, 0x6ED82B7F, 0x639B0DA6, 0x675A1011, 0x791D4014, 0x7DDC5DA3,
  127. 0x709F7B7A, 0x745E66CD, 0x9823B6E0, 0x9CE2AB57, 0x91A18D8E, 0x95609039,
  128. 0x8B27C03C, 0x8FE6DD8B, 0x82A5FB52, 0x8664E6E5, 0xBE2B5B58, 0xBAEA46EF,
  129. 0xB7A96036, 0xB3687D81, 0xAD2F2D84, 0xA9EE3033, 0xA4AD16EA, 0xA06C0B5D,
  130. 0xD4326D90, 0xD0F37027, 0xDDB056FE, 0xD9714B49, 0xC7361B4C, 0xC3F706FB,
  131. 0xCEB42022, 0xCA753D95, 0xF23A8028, 0xF6FB9D9F, 0xFBB8BB46, 0xFF79A6F1,
  132. 0xE13EF6F4, 0xE5FFEB43, 0xE8BCCD9A, 0xEC7DD02D, 0x34867077, 0x30476DC0,
  133. 0x3D044B19, 0x39C556AE, 0x278206AB, 0x23431B1C, 0x2E003DC5, 0x2AC12072,
  134. 0x128E9DCF, 0x164F8078, 0x1B0CA6A1, 0x1FCDBB16, 0x018AEB13, 0x054BF6A4,
  135. 0x0808D07D, 0x0CC9CDCA, 0x7897AB07, 0x7C56B6B0, 0x71159069, 0x75D48DDE,
  136. 0x6B93DDDB, 0x6F52C06C, 0x6211E6B5, 0x66D0FB02, 0x5E9F46BF, 0x5A5E5B08,
  137. 0x571D7DD1, 0x53DC6066, 0x4D9B3063, 0x495A2DD4, 0x44190B0D, 0x40D816BA,
  138. 0xACA5C697, 0xA864DB20, 0xA527FDF9, 0xA1E6E04E, 0xBFA1B04B, 0xBB60ADFC,
  139. 0xB6238B25, 0xB2E29692, 0x8AAD2B2F, 0x8E6C3698, 0x832F1041, 0x87EE0DF6,
  140. 0x99A95DF3, 0x9D684044, 0x902B669D, 0x94EA7B2A, 0xE0B41DE7, 0xE4750050,
  141. 0xE9362689, 0xEDF73B3E, 0xF3B06B3B, 0xF771768C, 0xFA325055, 0xFEF34DE2,
  142. 0xC6BCF05F, 0xC27DEDE8, 0xCF3ECB31, 0xCBFFD686, 0xD5B88683, 0xD1799B34,
  143. 0xDC3ABDED, 0xD8FBA05A, 0x690CE0EE, 0x6DCDFD59, 0x608EDB80, 0x644FC637,
  144. 0x7A089632, 0x7EC98B85, 0x738AAD5C, 0x774BB0EB, 0x4F040D56, 0x4BC510E1,
  145. 0x46863638, 0x42472B8F, 0x5C007B8A, 0x58C1663D, 0x558240E4, 0x51435D53,
  146. 0x251D3B9E, 0x21DC2629, 0x2C9F00F0, 0x285E1D47, 0x36194D42, 0x32D850F5,
  147. 0x3F9B762C, 0x3B5A6B9B, 0x0315D626, 0x07D4CB91, 0x0A97ED48, 0x0E56F0FF,
  148. 0x1011A0FA, 0x14D0BD4D, 0x19939B94, 0x1D528623, 0xF12F560E, 0xF5EE4BB9,
  149. 0xF8AD6D60, 0xFC6C70D7, 0xE22B20D2, 0xE6EA3D65, 0xEBA91BBC, 0xEF68060B,
  150. 0xD727BBB6, 0xD3E6A601, 0xDEA580D8, 0xDA649D6F, 0xC423CD6A, 0xC0E2D0DD,
  151. 0xCDA1F604, 0xC960EBB3, 0xBD3E8D7E, 0xB9FF90C9, 0xB4BCB610, 0xB07DABA7,
  152. 0xAE3AFBA2, 0xAAFBE615, 0xA7B8C0CC, 0xA379DD7B, 0x9B3660C6, 0x9FF77D71,
  153. 0x92B45BA8, 0x9675461F, 0x8832161A, 0x8CF30BAD, 0x81B02D74, 0x857130C3,
  154. 0x5D8A9099, 0x594B8D2E, 0x5408ABF7, 0x50C9B640, 0x4E8EE645, 0x4A4FFBF2,
  155. 0x470CDD2B, 0x43CDC09C, 0x7B827D21, 0x7F436096, 0x7200464F, 0x76C15BF8,
  156. 0x68860BFD, 0x6C47164A, 0x61043093, 0x65C52D24, 0x119B4BE9, 0x155A565E,
  157. 0x18197087, 0x1CD86D30, 0x029F3D35, 0x065E2082, 0x0B1D065B, 0x0FDC1BEC,
  158. 0x3793A651, 0x3352BBE6, 0x3E119D3F, 0x3AD08088, 0x2497D08D, 0x2056CD3A,
  159. 0x2D15EBE3, 0x29D4F654, 0xC5A92679, 0xC1683BCE, 0xCC2B1D17, 0xC8EA00A0,
  160. 0xD6AD50A5, 0xD26C4D12, 0xDF2F6BCB, 0xDBEE767C, 0xE3A1CBC1, 0xE760D676,
  161. 0xEA23F0AF, 0xEEE2ED18, 0xF0A5BD1D, 0xF464A0AA, 0xF9278673, 0xFDE69BC4,
  162. 0x89B8FD09, 0x8D79E0BE, 0x803AC667, 0x84FBDBD0, 0x9ABC8BD5, 0x9E7D9662,
  163. 0x933EB0BB, 0x97FFAD0C, 0xAFB010B1, 0xAB710D06, 0xA6322BDF, 0xA2F33668,
  164. 0xBCB4666D, 0xB8757BDA, 0xB5365D03, 0xB1F740B4
  165. };
  166. static UInt32 crc32_cal(byte[] pData, UInt16 Length)
  167. {
  168. UInt32 nReg;
  169. UInt32 nTemp = 0;
  170. UInt16 i, n;
  171. nReg = 0xFFFFFFFF;
  172. for (n = 0; n < Length; n++)
  173. {
  174. nReg ^= (UInt32)pData[n];
  175. for (i = 0; i < 4; i++)
  176. {
  177. nTemp = crc32_table[((nReg >> 24) & 0xFF)];
  178. nReg <<= 8;
  179. nReg ^= nTemp;
  180. }
  181. }
  182. return nReg;
  183. }
  184. #endregion
  185. #region 命令发送
  186. private void SendCmd(ushort ID, byte Mode, ushort Cmd, byte[] Data)
  187. {
  188. if (!portsettings_form.serialPort1.IsOpen)
  189. {
  190. MessageBox.Show("串口未连接");
  191. return;
  192. }
  193. ushort DataLength = (ushort)(Cmd & 0xFF);
  194. var SendCmdTmp = new byte[DataLength + 13];
  195. //帧头
  196. SendCmdTmp[0] = 0x55;
  197. SendCmdTmp[1] = 0xAA;
  198. //ID
  199. SendCmdTmp[2] = (byte)(ID >> 8);
  200. SendCmdTmp[3] = (byte)(ID & 0xFF);
  201. //MODE
  202. SendCmdTmp[4] = Mode;
  203. //长度
  204. SendCmdTmp[5] = (byte)((Cmd & 0xFF) + 2);
  205. //命令字
  206. SendCmdTmp[6] = (byte)(Cmd >> 8);
  207. SendCmdTmp[7] = (byte)(Cmd & 0xFF);
  208. //数据段
  209. for (UInt16 i = 0; i < (Cmd & 0xFF); i++)
  210. {
  211. SendCmdTmp[8 + i] = Data[i];
  212. }
  213. //校验
  214. UInt32 CRC_Result = crc32_cal(SendCmdTmp, (ushort)(DataLength + 8));
  215. SendCmdTmp[DataLength + 8] = Convert.ToByte(CRC_Result >> 24);
  216. SendCmdTmp[DataLength + 9] = Convert.ToByte((CRC_Result >> 16) % 256);
  217. SendCmdTmp[DataLength + 10] = Convert.ToByte((CRC_Result >> 8) % 256);
  218. SendCmdTmp[DataLength + 11] = Convert.ToByte(CRC_Result % 256);
  219. //帧尾
  220. SendCmdTmp[DataLength + 12] = 0xF0;
  221. //发送数据
  222. portsettings_form.serialPort1.Write(SendCmdTmp, 0, SendCmdTmp.Length);
  223. }
  224. #endregion
  225. #region 串口数据解析
  226. private void Serial_DataReceived_Process()
  227. {
  228. //串口解析
  229. byte DataNum = 0; //记录每条命令数据段的长度
  230. while (buffer.Count >= 13)//当buffer中的数据的个数大于等于4个时,即每一帧的数据长度所在位(第4位)出现时
  231. {
  232. if (buffer[0] == 0x55 && buffer[1] == 0xAA)//判断帧头
  233. {
  234. ushort PackageID;
  235. PackageID = (ushort)(buffer[2] * 256 + buffer[3]);
  236. if ((PackageID == 0x0710) || (PackageID == 0x0715) || (PackageID == 0x0610) || (PackageID == 0x0615) || (PackageID == 0x07FF))
  237. {
  238. int CmdLen = buffer[5];
  239. if (buffer.Count < CmdLen + 11) break;//如果接收到的数据没有达到一帧数据的指定长度, 则执行下次循环
  240. buffer.RemoveRange(0, 6);//数据达到要求长度后删去帧头,ID,模式,和命令长度
  241. DataNum = (byte)(buffer[1]);//命令字的第二个字节的表示数据位的长度
  242. if (DataNum == (CmdLen - 2))
  243. {
  244. for (int i = 0; i < DataNum + 2; i++)
  245. {
  246. binary_data_1[i] = buffer[i];
  247. }
  248. if (TestStep == TestStep_Enum.Step_Save)
  249. {
  250. //数据存储
  251. var RecData = new byte[CmdLen];
  252. Array.Copy(binary_data_1, RecData, CmdLen);
  253. DataSave(RecData);
  254. }
  255. DataCmdProcess(PackageID);//对于不同的命令段,做不同的处理
  256. }
  257. buffer.RemoveRange(0, CmdLen + 5);//解析完成
  258. }
  259. else
  260. {
  261. buffer.RemoveAt(0);//ID不对
  262. }
  263. }
  264. else
  265. {
  266. buffer.RemoveAt(0);//帧头不对,删除帧头高字节
  267. }
  268. }
  269. }
  270. #endregion
  271. #region 数据存储
  272. private void DataSave(byte[] Data)
  273. {
  274. string SaveData = "";
  275. //数据存储
  276. for (int i = 0; i < Data.Length; i++)
  277. {
  278. SaveData += Convert.ToString(Data[i], 16).PadLeft(2, '0').ToUpper() + " ";
  279. }
  280. SaveData += "\r\n";
  281. System.IO.File.AppendAllText(LogSaveFileName, SaveData);
  282. }
  283. #endregion
  284. //故障转换和显示
  285. List<string> ErrorInfo = new List<string>{ "过流保护", "低压保护", "过压保护", "堵转保护","过热保护","速度传感器故障","力矩传感器故障","霍尔故障",
  286. "马达缺相","NTC故障","","","","MCU故障","踏频传感器故障","指拨故障","MOS短路","电压异常","电路故障","TE故障","TE电路故障","","","","","","","","","",
  287. "",""};
  288. private void ErrorInfoDisplay(UInt32 Code)
  289. {
  290. label_ErrorInfo.Text = "";
  291. if (Code == 0)
  292. {
  293. label_ErrorInfo.Text = "无故障";
  294. label_ErrorInfo.ForeColor = Color.Green;
  295. }
  296. else
  297. {
  298. label_ErrorInfo.ForeColor = Color.Red;
  299. for (int i = 0; i < 32; i++)
  300. {
  301. if ((Code & 0x01) == 0x01)
  302. {
  303. label_ErrorInfo.Text += ErrorInfo[i] + " ";
  304. }
  305. Code >>= 1;
  306. }
  307. }
  308. }
  309. #region 数据解析处理
  310. private void DataCmdProcess(ushort ID)
  311. {
  312. ushort CmdTemp = (ushort)(binary_data_1[0] * 256 + binary_data_1[1]);
  313. ushort DataTemp;
  314. #region 主控信息
  315. if ((ID == 0x715) || (ID == 0x710))
  316. {
  317. switch (CmdTemp)
  318. {
  319. case 0x1020://电机运行信息
  320. {
  321. unchecked
  322. {
  323. this.Invoke((EventHandler)(delegate
  324. {
  325. MC_RunInfo_Refresh = true;
  326. //车速
  327. DataTemp = (ushort)(binary_data_1[3] * 256 + binary_data_1[2]);
  328. textBox_BikeSpeed.Text = ((float)DataTemp / 10f).ToString("0.0");
  329. //输出转速
  330. DataTemp = (ushort)(binary_data_1[5] * 256 + binary_data_1[4]);
  331. textBox_MotorSpeed.Text = Convert.ToString(DataTemp);
  332. //母线电压
  333. DataTemp = (ushort)(binary_data_1[9] * 256 + binary_data_1[8]);
  334. textBox_Vol.Text = Convert.ToString(DataTemp);
  335. //母线电流
  336. DataTemp = (ushort)(binary_data_1[11] * 256 + binary_data_1[10]);
  337. textBox_Cur.Text = Convert.ToString(DataTemp);
  338. //踏频
  339. DataTemp = (ushort)(binary_data_1[12]);
  340. textBox_Cadence.Text = Convert.ToString(DataTemp);
  341. //踩踏力矩
  342. DataTemp = (ushort)(binary_data_1[13]);
  343. textBox_Torque.Text = Convert.ToString(DataTemp);
  344. //踩踏方向
  345. DataTemp = (ushort)(binary_data_1[14]);
  346. if (DataTemp == 0)
  347. {
  348. textBox_Dir.Text = "正向";
  349. }
  350. else if (DataTemp == 1)
  351. {
  352. textBox_Dir.Text = "反向";
  353. }
  354. else if (DataTemp == 2)
  355. {
  356. textBox_Dir.Text = "停止";
  357. }
  358. //PCB温度
  359. DataTemp = (ushort)(binary_data_1[23]);
  360. textBox_PCB.Text = Convert.ToString((int)(DataTemp - 40));
  361. //绕组温度
  362. DataTemp = (ushort)(binary_data_1[24]);
  363. textBox_Coil.Text = Convert.ToString((int)(DataTemp - 40));
  364. //MCU温度
  365. DataTemp = (ushort)(binary_data_1[25]);
  366. textBox_MCU.Text = Convert.ToString((int)(DataTemp - 40));
  367. }));
  368. }
  369. break;
  370. }
  371. case 0x1104://故障码
  372. {
  373. unchecked
  374. {
  375. _ = this.Invoke((EventHandler)(delegate
  376. {
  377. MC_ErrorCode_Refresh = true;
  378. label_error_code.Text =
  379. Convert.ToString(binary_data_1[5], 16).PadLeft(2, '0').ToUpper() +
  380. Convert.ToString(binary_data_1[4], 16).PadLeft(2, '0').ToUpper() +
  381. Convert.ToString(binary_data_1[3], 16).PadLeft(2, '0').ToUpper() +
  382. Convert.ToString(binary_data_1[2], 16).PadLeft(2, '0').ToUpper() +
  383. "H";
  384. label_error_code.BackColor = Color.Red;
  385. UInt32 ErrorCode = (UInt32)((binary_data_1[5] << 24) + (binary_data_1[4] << 16) + (binary_data_1[3] << 8) + binary_data_1[2]);
  386. ErrorInfoDisplay(ErrorCode);
  387. }));
  388. }
  389. break;
  390. }
  391. case 0x1240://电机版本信息
  392. {
  393. unchecked
  394. {
  395. this.Invoke((EventHandler)(delegate
  396. {
  397. //电机型号
  398. richTextBox_Ver.Text += "型号:";
  399. for (ushort i = 0; i < 16; i++)
  400. {
  401. if (binary_data_1[2 + i] == 0x2E)
  402. {
  403. break;
  404. }
  405. richTextBox_Ver.Text += ((char)binary_data_1[2 + i]).ToString();
  406. }
  407. richTextBox_Ver.Text += "\r\n";
  408. //电机SN
  409. richTextBox_Ver.Text += "序列号:";
  410. for (ushort i = 0; i < 16; i++)
  411. {
  412. if (binary_data_1[18 + i] == 0x2E)
  413. {
  414. break;
  415. }
  416. richTextBox_Ver.Text += ((char)binary_data_1[18 + i]).ToString();
  417. }
  418. richTextBox_Ver.Text += "\r\n";
  419. //电机HW
  420. richTextBox_Ver.Text += "硬件版本:";
  421. for (ushort i = 0; i < 16; i++)
  422. {
  423. if (binary_data_1[34 + i] == 0x2E)
  424. {
  425. break;
  426. }
  427. if (binary_data_1[34 + i] == 'r')
  428. {
  429. binary_data_1[34 + i] = (byte)'.';
  430. }
  431. richTextBox_Ver.Text += ((char)binary_data_1[34 + i]).ToString();
  432. }
  433. richTextBox_Ver.Text += "\r\n";
  434. //电机FW
  435. richTextBox_Ver.Text += "软件版本:";
  436. for (ushort i = 0; i < 16; i++)
  437. {
  438. if (binary_data_1[50 + i] == 0x2E)
  439. {
  440. break;
  441. }
  442. if (binary_data_1[50 + i] == 'r')
  443. {
  444. binary_data_1[50 + i] = (byte)'.';
  445. }
  446. richTextBox_Ver.Text += ((char)binary_data_1[50 + i]).ToString();
  447. }
  448. richTextBox_Ver.Text += "\r\n";
  449. }));
  450. }
  451. break;
  452. }
  453. case 0x1720://电机程序特性信息
  454. {
  455. unchecked
  456. {
  457. this.Invoke((EventHandler)(delegate
  458. {
  459. //程序特性
  460. for (ushort i = 0; i < 32; i++)
  461. {
  462. if (binary_data_1[2 + i] == 0x2E)
  463. {
  464. break;
  465. }
  466. if (binary_data_1[2 + i] == 'r')
  467. {
  468. binary_data_1[2 + i] = (byte)'.';
  469. }
  470. richTextBox_Ver.Text += ((char)binary_data_1[2 + i]).ToString();
  471. }
  472. richTextBox_Ver.Text += "\r\n";
  473. }));
  474. }
  475. break;
  476. }
  477. case 0xA903://反馈指令
  478. {
  479. unchecked
  480. {
  481. this.Invoke((EventHandler)(delegate
  482. {
  483. Ack_Flag = true;
  484. StepTestFlag = StepTestResult_Enum.StepTestResult_OK;
  485. }));
  486. }
  487. break;
  488. }
  489. default: break;
  490. }
  491. }
  492. #endregion
  493. else if ((ID == 0x615) || (ID == 0x610))
  494. {
  495. switch (CmdTemp)
  496. {
  497. case 0x1240://TE APP版本信息
  498. {
  499. unchecked
  500. {
  501. this.Invoke((EventHandler)(delegate
  502. {
  503. //TE 软件版本
  504. richTextBox_Ver.Text += "TE软件版本:";
  505. for (ushort i = 0; i < 16; i++)
  506. {
  507. if (binary_data_1[50 + i] == 0x2E)
  508. {
  509. break;
  510. }
  511. if (binary_data_1[50 + i] == 'r')
  512. {
  513. binary_data_1[50 + i] = (byte)'.';
  514. }
  515. richTextBox_Ver.Text += ((char)binary_data_1[50 + i]).ToString();
  516. }
  517. }));
  518. }
  519. break;
  520. }
  521. default: break;
  522. }
  523. }
  524. }
  525. #endregion
  526. //20ms定时器
  527. private void timer1_Tick(object sender, EventArgs e)
  528. {
  529. //串口数据解析
  530. Serial_DataReceived_Process();
  531. }
  532. #region 非独占性延时函数
  533. public static void Delay_ms(int milliSecond)
  534. {
  535. int start = Environment.TickCount;
  536. while (Math.Abs(Environment.TickCount - start) < milliSecond)//毫秒
  537. {
  538. Application.DoEvents();
  539. }
  540. }
  541. #endregion
  542. //电机运行信息清除
  543. private void MC_RunInfo_Clear()
  544. {
  545. foreach (Control c in groupBox9.Controls)
  546. {
  547. if (c is TextBox)
  548. {
  549. c.Text = "---";
  550. }
  551. }
  552. }
  553. private void ImportForm_FormClosing(object sender, FormClosingEventArgs e)
  554. {
  555. portsettings_form.serialPort1.Close();
  556. portsettings_form.comboBox_ComIndex.Enabled = true;
  557. portsettings_form.button_ComOpen.Text = "连接";
  558. portsettings_form.g_blnIsOpen = false;
  559. }
  560. //开关灯
  561. private void LightProcess()
  562. {
  563. var CtrlCode = new byte[2];
  564. CtrlCode[0] = 0x00;
  565. if (button_LightCtl.Text == "开灯")
  566. {
  567. button_LightCtl.Text = "关灯";
  568. CtrlCode[1] = 0xF1;
  569. button_LightCtl.BackColor = Color.Yellow;
  570. button_LightCtl.ForeColor = Color.Black;
  571. }
  572. else
  573. {
  574. button_LightCtl.Text = "开灯";
  575. CtrlCode[1] = 0xF0;
  576. button_LightCtl.BackColor = Color.Gray;
  577. button_LightCtl.ForeColor = Color.White;
  578. }
  579. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x2802, CtrlCode);
  580. }
  581. //开关灯按钮
  582. private void button_LightCtl_Click(object sender, EventArgs e)
  583. {
  584. LightProcess();
  585. }
  586. //电机启动/停止控制
  587. private void Walk_Process(byte GearSt)
  588. {
  589. var Code = new byte[2];
  590. if (button_Walk.Text == "启动")
  591. {
  592. button_Walk.Text = "停止";
  593. //发送指令使电机进入配置模式
  594. Code[0] = 0x01;
  595. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x1901, Code);
  596. Thread.Sleep(200);
  597. //发送指令进入设定档位
  598. Code[0] = GearSt;
  599. if (button_LightCtl.Text == "关灯")
  600. Code[1] = 0xF1;
  601. else
  602. Code[1] = 0xF0;
  603. button_Walk.BackColor = Color.Yellow;
  604. button_Walk.ForeColor = Color.Black;
  605. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x2802, Code);
  606. }
  607. else
  608. {
  609. button_Walk.Text = "启动";
  610. //发送指令关闭档位模式
  611. Code[0] = 0x00;
  612. if (button_LightCtl.Text == "关灯")
  613. Code[1] = 0xF1;
  614. else
  615. Code[1] = 0xF0;
  616. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x2802, Code);
  617. Thread.Sleep(200);
  618. //发送指令使电机退出配置模式
  619. Code[0] = 0x00;
  620. button_Walk.BackColor = Color.Gray;
  621. button_Walk.ForeColor = Color.White;
  622. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x1901, Code);
  623. }
  624. }
  625. //电机启动/停止按钮
  626. private void button_Walk_Click(object sender, EventArgs e)
  627. {
  628. Walk_Process(0x22);
  629. }
  630. //查询版本信息
  631. private void button_Check_Ver_Click(object sender, EventArgs e)
  632. {
  633. richTextBox_Ver.Text = "";
  634. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x1200, null);
  635. Delay_ms(200);
  636. SendCmd((ushort)0x651, (byte)0x11, (ushort)0x1200, null);
  637. }
  638. //按钮初始化
  639. private void label_Init()
  640. {
  641. radioButton_Light_OK.Checked = false;//灯电压确认按钮
  642. radioButton_Light_NG.Checked = false;
  643. label_error_code.BackColor = Color.Green;//故障码
  644. label_error_code.Text = "OK";
  645. label_Sta_Clear.BackColor = Color.Red;//系统清除
  646. label_Sta_Clear.Text = "NG";
  647. label_Sta_Write.BackColor = Color.Red;//参数写入
  648. label_Sta_Write.Text = "NG";
  649. label_sta_light.BackColor = Color.Red;//灯电压
  650. label_sta_light.Text = "NG";
  651. label_sensor_vol.BackColor = Color.Red;//电压检测
  652. label_sensor_vol.Text = "NG";
  653. label_sensor_cur.BackColor = Color.Red;//电流检测
  654. label_sensor_cur.Text = "NG";
  655. label_sensor_speed.BackColor = Color.Red;//车速检测
  656. label_sensor_speed.Text = "NG";
  657. label_sensor_cadence.BackColor = Color.Red;//踏频检测
  658. label_sensor_cadence.Text = "NG";
  659. label_sensor_motor.BackColor = Color.Red;//电机转速检测
  660. label_sensor_motor.Text = "NG";
  661. label_sensor_PCB_temp.BackColor = Color.Red;//PCB温度检测
  662. label_sensor_PCB_temp.Text = "NG";
  663. label_sensor_coil_temp.BackColor = Color.Red;//绕组温度检测
  664. label_sensor_coil_temp.Text = "NG";
  665. label_sensor_MCU_temp.BackColor = Color.Red;//MCU温度检测
  666. label_sensor_MCU_temp.Text = "NG";
  667. label_Sensor_Break.BackColor = Color.Red;//断电刹把
  668. label_Sensor_Break.Text = "NG";
  669. label_Sensor_Gas.BackColor = Color.Red;//转把
  670. label_Sensor_Gas.Text = "NG";
  671. label_FW_Version.BackColor = Color.Red;//版本信息
  672. label_FW_Version.Text = "NG";
  673. label_Result.BackColor = Color.Red;//测试结果
  674. label_Result.Text = "不合格";
  675. richTextBox_Ver.Text = "";//版本信息
  676. richTextBox_TestRecord.Text = "";//测试过程记录
  677. }
  678. //执行一次测试任务
  679. private void Thread_Task()
  680. {
  681. //开始测试
  682. richTextBox_TestRecord.Text += "电机信息:" + textBox_PDinfo.Text + "\r\n";
  683. richTextBox_TestRecord.Text += "配置文件:" + comboBox_File.Text + "\r\n";
  684. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "开始测试" + "\r\n";
  685. //公有变量
  686. var Code = new byte[32];//发送的指令数据
  687. ushort DataTemp;
  688. short DataTemp_Int16;
  689. #region Step1:发送指令,系统清除
  690. TestStep = TestStep_Enum.Step_SysClear;
  691. label_Step.Text = "系统清除,请等待!";
  692. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "发送系统清除指令" + "\r\n";
  693. Code[0] = (byte)'C';
  694. Code[1] = (byte)'L';
  695. Code[2] = (byte)'E';
  696. Code[3] = (byte)'A';
  697. Code[4] = (byte)'R';
  698. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x2605, Code);
  699. Ack_Flag = false;
  700. Ack_Cnt = 0;
  701. StepTestFlag = StepTestResult_Enum.StepTestResult_Testing;
  702. while (StepTestFlag == StepTestResult_Enum.StepTestResult_Testing);//等待测试结束
  703. if (StepTestFlag == StepTestResult_Enum.StepTestResult_OK)//成功
  704. {
  705. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "系统清除成功" + "\r\n";
  706. label_Sta_Clear.BackColor = Color.Green;
  707. label_Sta_Clear.Text = "OK";
  708. }
  709. else//失败
  710. {
  711. label_Step.Text = "系统清除失败,测试结束!";
  712. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "系统清除失败,测试结束" + "\r\n";
  713. button_Start.Enabled = true;
  714. return;
  715. }
  716. #endregion
  717. //系统清除完成后会重启,等待3s
  718. Delay_ms(3000);
  719. #region Step2:发送指令,依次写入参数
  720. TestStep = TestStep_Enum.Step_Write;
  721. label_Step.Text = "参数写入中,请等待!";
  722. #region Step2.1:写入电机型号和序列号
  723. string Mode = "", SN = "";
  724. if (textBox_PDinfo.Text.Contains("%#") == true)
  725. {
  726. Mode = Regex.Split(textBox_PDinfo.Text, "%#", RegexOptions.IgnoreCase)[0];
  727. SN = Regex.Split(textBox_PDinfo.Text, "%#", RegexOptions.IgnoreCase)[1];
  728. }
  729. else if (textBox_PDinfo.Text.Contains(" ") == true)
  730. {
  731. Mode = Regex.Split(textBox_PDinfo.Text, " ", RegexOptions.IgnoreCase)[0];
  732. SN = Regex.Split(textBox_PDinfo.Text, " ", RegexOptions.IgnoreCase)[1];
  733. }
  734. else
  735. {
  736. label_Step.Text = "打标信息错误,测试结束!";
  737. button_Start.Enabled = true;
  738. return;
  739. }
  740. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "写入电机型号" + "\r\n";
  741. for (ushort i = 0; i < ((Mode.Length > 16) ? 16 : Mode.Length); i++)
  742. {
  743. Code[i] = (byte)Mode[i];
  744. }
  745. if (Mode.Length < 16)
  746. {
  747. Code[Mode.Length] = (byte)'.';
  748. for (ushort i = 0; i < 16 - Mode.Length - 1; i++)
  749. {
  750. Code[Mode.Length + 1 + i] = 0x20;
  751. }
  752. }
  753. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x2210, Code);
  754. Ack_Flag = false;
  755. Ack_Cnt = 0;
  756. StepTestFlag = StepTestResult_Enum.StepTestResult_Testing;
  757. while (StepTestFlag == StepTestResult_Enum.StepTestResult_Testing) ;//等待测试结束
  758. if (StepTestFlag == StepTestResult_Enum.StepTestResult_OK)//成功
  759. {
  760. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "电机型号写入成功" + "\r\n";
  761. }
  762. else//失败
  763. {
  764. label_Step.Text = "参数写入失败,测试结束!";
  765. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "电机型号写入失败,测试结束" + "\r\n";
  766. button_Start.Enabled = true;
  767. return;
  768. }
  769. Delay_ms(200);
  770. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "写入电机序列号" + "\r\n";
  771. for (ushort i = 0; i < ((SN.Length > 16) ? 16 : SN.Length); i++)
  772. {
  773. Code[i] = (byte)SN[i];
  774. }
  775. if (SN.Length < 16)
  776. {
  777. Code[SN.Length] = (byte)'.';
  778. for (ushort i = 0; i < 16 - SN.Length - 1; i++)
  779. {
  780. Code[SN.Length + 1 + i] = 0x20;
  781. }
  782. }
  783. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x2310, Code);
  784. Ack_Flag = false;
  785. Ack_Cnt = 0;
  786. StepTestFlag = StepTestResult_Enum.StepTestResult_Testing;
  787. while (StepTestFlag == StepTestResult_Enum.StepTestResult_Testing) ;//等待测试结束
  788. if (StepTestFlag == StepTestResult_Enum.StepTestResult_OK)//成功
  789. {
  790. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "电机序列号写入成功" + "\r\n";
  791. }
  792. else//失败
  793. {
  794. label_Step.Text = "参数写入失败,测试结束!";
  795. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "电机序列号写入失败,测试结束" + "\r\n";
  796. button_Start.Enabled = true;
  797. return;
  798. }
  799. #endregion
  800. #region Step2.2:写入用户参数1
  801. Delay_ms(200);
  802. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "写入用户参数1" + "\r\n";
  803. //指拨模式
  804. Code[0] = Convert.ToByte(array_CfgInfo[25].ToString().Split(',')[1]);
  805. //启动模式
  806. Code[1] = Convert.ToByte(array_CfgInfo[1].ToString().Split(',')[1]);
  807. //停机时间
  808. DataTemp = Convert.ToUInt16(array_CfgInfo[2].ToString().Split(',')[1]);
  809. Code[2] = (byte)(DataTemp & 0xFF);
  810. Code[3] = (byte)(DataTemp >> 8);
  811. //限速
  812. Code[4] = Convert.ToByte(array_CfgInfo[3].ToString().Split(',')[1]);
  813. //下降速度
  814. Code[5] = Convert.ToByte(array_CfgInfo[4].ToString().Split(',')[1]);
  815. //前飞
  816. Code[6] = Convert.ToByte(array_CfgInfo[5].ToString().Split(',')[1]);
  817. //后飞
  818. Code[7] = Convert.ToByte(array_CfgInfo[6].ToString().Split(',')[1]);
  819. //限流
  820. Code[8] = Convert.ToByte(array_CfgInfo[7].ToString().Split(',')[1]);
  821. //温度预警
  822. Code[9] = (byte)(Convert.ToByte(array_CfgInfo[8].ToString().Split(',')[1]) + 40);
  823. //温度保护
  824. Code[10] = (byte)(Convert.ToByte(array_CfgInfo[9].ToString().Split(',')[1]) + 40);
  825. //无PBU
  826. Code[11] = Convert.ToByte(array_CfgInfo[10].ToString().Split(',')[1]);
  827. //轮胎周长
  828. Code[12] = Convert.ToByte(array_CfgInfo[11].ToString().Split(',')[1]);
  829. //电机系列号
  830. Code[13] = Convert.ToByte(array_CfgInfo[12].ToString().Split(',')[1]);
  831. //ECO助力增益
  832. Code[14] = Convert.ToByte(array_CfgInfo[13].ToString().Split(',')[1]);
  833. //ECO加速
  834. Code[15] = Convert.ToByte(array_CfgInfo[14].ToString().Split(',')[1]);
  835. //NORM助力增益
  836. Code[16] = Convert.ToByte(array_CfgInfo[15].ToString().Split(',')[1]);
  837. //NORM加速
  838. Code[17] = Convert.ToByte(array_CfgInfo[16].ToString().Split(',')[1]);
  839. //SPORT助力增益
  840. Code[18] = Convert.ToByte(array_CfgInfo[17].ToString().Split(',')[1]);
  841. //SPORT加速
  842. Code[19] = Convert.ToByte(array_CfgInfo[18].ToString().Split(',')[1]);
  843. //TURBO助力增益
  844. Code[20] = Convert.ToByte(array_CfgInfo[19].ToString().Split(',')[1]);
  845. //TURBO加速
  846. Code[21] = Convert.ToByte(array_CfgInfo[20].ToString().Split(',')[1]);
  847. //SMART助力增益
  848. Code[22] = Convert.ToByte(array_CfgInfo[21].ToString().Split(',')[1]);
  849. //SMART加速
  850. Code[23] = Convert.ToByte(array_CfgInfo[22].ToString().Split(',')[1]);
  851. //速度传感器信号个数
  852. Code[24] = Convert.ToByte(array_CfgInfo[23].ToString().Split(',')[1]);
  853. //踏频启动信号个数
  854. Code[25] = Convert.ToByte(array_CfgInfo[24].ToString().Split(',')[1]);
  855. //速度传感器
  856. Code[26] = Convert.ToByte(array_CfgInfo[26].ToString().Split(',')[1]);
  857. //周长微调
  858. Code[27] = (byte)Convert.ToInt16(array_CfgInfo[27].ToString().Split(',')[1]);
  859. //低压保护阈值
  860. DataTemp = Convert.ToUInt16(array_CfgInfo[28].ToString().Split(',')[1]);
  861. Code[28] = (byte)(DataTemp & 0xFF);
  862. Code[29] = (byte)(DataTemp >> 8);
  863. //推行限速
  864. DataTemp = Convert.ToByte(array_CfgInfo[29].ToString().Split(',')[1]);
  865. Code[30] = (byte)Convert.ToByte(DataTemp);
  866. //推行马达转速
  867. Code[31] = (byte)Convert.ToByte(array_CfgInfo[30].ToString().Split(',')[1]);
  868. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x1B20, Code);
  869. Ack_Flag = false;
  870. Ack_Cnt = 0;
  871. StepTestFlag = StepTestResult_Enum.StepTestResult_Testing;
  872. while (StepTestFlag == StepTestResult_Enum.StepTestResult_Testing) ;//等待测试结束
  873. if (StepTestFlag == StepTestResult_Enum.StepTestResult_OK)//成功
  874. {
  875. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "用户参数1写入成功" + "\r\n";
  876. }
  877. else//失败
  878. {
  879. label_Step.Text = "参数写入失败,测试结束!";
  880. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "用户参数1写入失败,测试结束" + "\r\n";
  881. button_Start.Enabled = true;
  882. return;
  883. }
  884. #endregion
  885. #region Step2.3:写入用户参数2
  886. Delay_ms(200);
  887. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "写入用户参数2" + "\r\n";
  888. //俯仰角零偏
  889. DataTemp_Int16 = (short)(decimal.Parse(array_CfgInfo[34].ToString().Split(',')[1]) * 10);
  890. Code[0] = (byte)(DataTemp_Int16 & 0xFF);
  891. Code[1] = (byte)(DataTemp_Int16 >> 8);
  892. //横滚角零偏
  893. DataTemp_Int16 = (short)(decimal.Parse(array_CfgInfo[35].ToString().Split(',')[1]) * 10);
  894. Code[2] = (byte)(DataTemp_Int16 & 0xFF);
  895. Code[3] = (byte)(DataTemp_Int16 >> 8);
  896. //支持姿态传感器
  897. Code[4] = Convert.ToByte(array_CfgInfo[33].ToString().Split(',')[1]);
  898. //尾灯模式
  899. Code[5] = Convert.ToByte(array_CfgInfo[36].ToString().Split(',')[1]);
  900. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x3120, Code);
  901. Ack_Flag = false;
  902. Ack_Cnt = 0;
  903. StepTestFlag = StepTestResult_Enum.StepTestResult_Testing;
  904. while (StepTestFlag == StepTestResult_Enum.StepTestResult_Testing) ;//等待测试结束
  905. if (StepTestFlag == StepTestResult_Enum.StepTestResult_OK)//成功
  906. {
  907. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "用户参数2写入成功" + "\r\n";
  908. }
  909. else//失败
  910. {
  911. label_Step.Text = "参数写入失败,测试结束!";
  912. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "用户参数2写入失败,测试结束" + "\r\n";
  913. button_Start.Enabled = true;
  914. return;
  915. }
  916. #endregion
  917. #region Step2.4:写入马达参数
  918. Delay_ms(200);
  919. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "写入马达参数" + "\r\n";
  920. //额定功率
  921. DataTemp = Convert.ToUInt16(array_CfgInfo[39].ToString().Split(',')[1]);
  922. Code[0] = (byte)(DataTemp & 0xFF);
  923. Code[1] = (byte)(DataTemp >> 8);
  924. //额定转速
  925. DataTemp = Convert.ToUInt16(array_CfgInfo[40].ToString().Split(',')[1]);
  926. Code[2] = (byte)(DataTemp & 0xFF);
  927. Code[3] = (byte)(DataTemp >> 8);
  928. //定子电阻
  929. DataTemp = Convert.ToUInt16(array_CfgInfo[41].ToString().Split(',')[1]);
  930. Code[4] = (byte)(DataTemp & 0xFF);
  931. Code[5] = (byte)(DataTemp >> 8);
  932. //Lq
  933. DataTemp = Convert.ToUInt16(array_CfgInfo[42].ToString().Split(',')[1]);
  934. Code[6] = (byte)(DataTemp & 0xFF);
  935. Code[7] = (byte)(DataTemp >> 8);
  936. //Ld
  937. DataTemp = Convert.ToUInt16(array_CfgInfo[43].ToString().Split(',')[1]);
  938. Code[8] = (byte)(DataTemp & 0xFF);
  939. Code[9] = (byte)(DataTemp >> 8);
  940. //反电动势
  941. DataTemp = Convert.ToUInt16(array_CfgInfo[44].ToString().Split(',')[1]);
  942. Code[10] = (byte)(DataTemp & 0xFF);
  943. Code[11] = (byte)(DataTemp >> 8);
  944. //额定电压
  945. Code[12] = Convert.ToByte(array_CfgInfo[45].ToString().Split(',')[1]);
  946. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x1D10, Code);
  947. Ack_Flag = false;
  948. Ack_Cnt = 0;
  949. StepTestFlag = StepTestResult_Enum.StepTestResult_Testing;
  950. while (StepTestFlag == StepTestResult_Enum.StepTestResult_Testing) ;//等待测试结束
  951. if (StepTestFlag == StepTestResult_Enum.StepTestResult_OK)//成功
  952. {
  953. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "马达参数写入成功" + "\r\n";
  954. }
  955. else//失败
  956. {
  957. label_Step.Text = "参数写入失败,测试结束!";
  958. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "马达参数写入失败,测试结束" + "\r\n";
  959. button_Start.Enabled = true;
  960. return;
  961. }
  962. #endregion
  963. #region Step2.5:写入生产信息
  964. Delay_ms(200);
  965. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "写入生产信息" + "\r\n";
  966. string MAC_Info = array_CfgInfo[48].ToString().Split(',')[1];
  967. for (ushort i = 0; i < ((MAC_Info.Length > 8) ? 8 : MAC_Info.Length); i++)
  968. {
  969. Code[i] = (byte)MAC_Info[i];
  970. }
  971. MAC_Info = array_CfgInfo[49].ToString().Split(',')[1];
  972. for (ushort i = 0; i < ((MAC_Info.Length > 8) ? 8 : MAC_Info.Length); i++)
  973. {
  974. Code[8 + i] = (byte)MAC_Info[i];
  975. }
  976. MAC_Info = array_CfgInfo[50].ToString().Split(',')[1];
  977. for (ushort i = 0; i < ((MAC_Info.Length > 8) ? 8 : MAC_Info.Length); i++)
  978. {
  979. Code[16 + i] = (byte)MAC_Info[i];
  980. }
  981. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x2420, Code);
  982. Ack_Flag = false;
  983. Ack_Cnt = 0;
  984. StepTestFlag = StepTestResult_Enum.StepTestResult_Testing;
  985. while (StepTestFlag == StepTestResult_Enum.StepTestResult_Testing) ;//等待测试结束
  986. if (StepTestFlag == StepTestResult_Enum.StepTestResult_OK)//成功
  987. {
  988. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "生产信息写入成功" + "\r\n";
  989. }
  990. else//失败
  991. {
  992. label_Step.Text = "参数写入失败,测试结束!";
  993. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "生产信息写入失败,测试结束" + "\r\n";
  994. button_Start.Enabled = true;
  995. return;
  996. }
  997. #endregion
  998. #region Step2.6:写入校验密钥
  999. Delay_ms(200);
  1000. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "写入校验密钥" + "\r\n";
  1001. if (array_CfgInfo[51].ToString().EndsWith(",") == false)
  1002. {
  1003. string KeyString = array_CfgInfo[51].ToString().Split(',')[1];
  1004. for (ushort i = 0; i < ((KeyString.Length > 8) ? 8 : KeyString.Length); i++)
  1005. {
  1006. Code[i] = (byte)KeyString[i];
  1007. }
  1008. }
  1009. else
  1010. {
  1011. Code.Initialize();
  1012. }
  1013. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x1108, Code);
  1014. Ack_Flag = false;
  1015. Ack_Cnt = 0;
  1016. StepTestFlag = StepTestResult_Enum.StepTestResult_Testing;
  1017. while (StepTestFlag == StepTestResult_Enum.StepTestResult_Testing) ;//等待测试结束
  1018. if (StepTestFlag == StepTestResult_Enum.StepTestResult_OK)//成功
  1019. {
  1020. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "校验密钥写入成功" + "\r\n";
  1021. }
  1022. else//失败
  1023. {
  1024. label_Step.Text = "参数写入失败,测试结束!";
  1025. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "校验密钥写入失败,测试结束" + "\r\n";
  1026. button_Start.Enabled = true;
  1027. return;
  1028. }
  1029. #endregion
  1030. #region Step2.7:写入自定义信息1、2、3
  1031. //自定义信息1
  1032. Delay_ms(200);
  1033. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "写入自定义信息1" + "\r\n";
  1034. if (array_CfgInfo[52].ToString().EndsWith(",") == false)
  1035. {
  1036. string UserInfo1String = array_CfgInfo[52].ToString().Split(',')[1];
  1037. for (ushort i = 0; i < (UserInfo1String.Length > 16 ? 16 : UserInfo1String.Length); i++)
  1038. {
  1039. Code[i] = (byte)UserInfo1String[i];
  1040. }
  1041. }
  1042. else
  1043. {
  1044. Array.Clear(Code, 0, 16);
  1045. }
  1046. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x1410, Code);
  1047. Ack_Flag = false;
  1048. Ack_Cnt = 0;
  1049. StepTestFlag = StepTestResult_Enum.StepTestResult_Testing;
  1050. while (StepTestFlag == StepTestResult_Enum.StepTestResult_Testing) ;//等待测试结束
  1051. if (StepTestFlag == StepTestResult_Enum.StepTestResult_OK)//成功
  1052. {
  1053. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "自定义信息1写入成功" + "\r\n";
  1054. }
  1055. else//失败
  1056. {
  1057. label_Step.Text = "参数写入失败,测试结束!";
  1058. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "自定义信息1写入失败,测试结束" + "\r\n";
  1059. button_Start.Enabled = true;
  1060. return;
  1061. }
  1062. //自定义信息2
  1063. Delay_ms(200);
  1064. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "写入自定义信息2" + "\r\n";
  1065. if (array_CfgInfo[53].ToString().EndsWith(",") == false)
  1066. {
  1067. string UserInfo2String = array_CfgInfo[53].ToString().Split(',')[1];
  1068. for (ushort i = 0; i < (UserInfo2String.Length > 16 ? 16 : UserInfo2String.Length); i++)
  1069. {
  1070. Code[i] = (byte)UserInfo2String[i];
  1071. }
  1072. }
  1073. else
  1074. {
  1075. Array.Clear(Code, 0, 16);
  1076. }
  1077. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x1610, Code);
  1078. Ack_Flag = false;
  1079. Ack_Cnt = 0;
  1080. StepTestFlag = StepTestResult_Enum.StepTestResult_Testing;
  1081. while (StepTestFlag == StepTestResult_Enum.StepTestResult_Testing) ;//等待测试结束
  1082. if (StepTestFlag == StepTestResult_Enum.StepTestResult_OK)//成功
  1083. {
  1084. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "自定义信息2写入成功" + "\r\n";
  1085. }
  1086. else//失败
  1087. {
  1088. label_Step.Text = "参数写入失败,测试结束!";
  1089. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "自定义信息2写入失败,测试结束" + "\r\n";
  1090. button_Start.Enabled = true;
  1091. return;
  1092. }
  1093. //自定义信息3
  1094. Delay_ms(200);
  1095. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "写入自定义信息3" + "\r\n";
  1096. if (array_CfgInfo[54].ToString().EndsWith(",") == false)
  1097. {
  1098. string UserInfo3String = array_CfgInfo[54].ToString().Split(',')[1];
  1099. for (ushort i = 0; i < (UserInfo3String.Length > 16 ? 16 : UserInfo3String.Length); i++)
  1100. {
  1101. Code[i] = (byte)UserInfo3String[i];
  1102. }
  1103. }
  1104. else
  1105. {
  1106. Array.Clear(Code, 0, 16);
  1107. }
  1108. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x1810, Code);
  1109. Ack_Flag = false;
  1110. Ack_Cnt = 0;
  1111. StepTestFlag = StepTestResult_Enum.StepTestResult_Testing;
  1112. while (StepTestFlag == StepTestResult_Enum.StepTestResult_Testing) ;//等待测试结束
  1113. if (StepTestFlag == StepTestResult_Enum.StepTestResult_OK)//成功
  1114. {
  1115. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "自定义信息3写入成功" + "\r\n";
  1116. }
  1117. else//失败
  1118. {
  1119. label_Step.Text = "参数写入失败,测试结束!";
  1120. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "自定义信息3写入失败,测试结束" + "\r\n";
  1121. button_Start.Enabled = true;
  1122. return;
  1123. }
  1124. #endregion
  1125. //参数写入完成
  1126. label_Sta_Write.BackColor = Color.Green;
  1127. label_Sta_Write.Text = "OK";
  1128. #endregion
  1129. #region Step3:灯电压测试
  1130. TestStep = TestStep_Enum.Step_Light;
  1131. label_Step.Text = "灯电压测试,请确认电压!";
  1132. button_LightCtl.Text = "开灯";
  1133. LightProcess();
  1134. radioButton_Light_OK.Checked = false;
  1135. radioButton_Light_OK.Enabled = true;
  1136. radioButton_Light_NG.Checked = false;
  1137. radioButton_Light_NG.Enabled = true;
  1138. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "发送开灯指令,请确认灯电压是否正确……" + "\r\n";
  1139. while ((radioButton_Light_OK.Checked == false) && (radioButton_Light_NG.Checked == false)) ;
  1140. if (radioButton_Light_OK.Checked == true)
  1141. {
  1142. label_sta_light.BackColor = Color.Green;
  1143. label_sta_light.Text = "OK";
  1144. }
  1145. else if (radioButton_Light_NG.Checked == true)
  1146. {
  1147. label_sta_light.BackColor = Color.Red;
  1148. label_sta_light.Text = "NG";
  1149. }
  1150. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "灯电压确认完成" + "\r\n";
  1151. button_LightCtl.Text = "关灯";
  1152. LightProcess();
  1153. #endregion
  1154. #region Step4:推行测试
  1155. TestStep = TestStep_Enum.Step_Walk;
  1156. label_Step.Text = "推行测试,电机开始自动运转!";
  1157. button_Walk.Text = "启动";
  1158. Walk_Process(0x22);
  1159. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "电机进入推行模式,请注意安全!" + "\r\n";
  1160. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "传感器自动检测开始" + "\r\n";
  1161. OK_cnt = 0;
  1162. WalkProcess_Cnt = 0;
  1163. while (WalkProcess_Cnt < 20)//开始判断传感器,超时20s
  1164. {
  1165. //车速传感器
  1166. if (SpeedSensorTest == false)
  1167. {
  1168. if (label_sensor_speed.BackColor == Color.Red)
  1169. {
  1170. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "跳过车速传感器测试" + "\r\n";
  1171. label_sensor_speed.BackColor = Color.Green;
  1172. label_sensor_speed.Text = "OK";
  1173. OK_cnt++;
  1174. }
  1175. }
  1176. else
  1177. {
  1178. DataTemp = (ushort)(Convert.ToDecimal(textBox_BikeSpeed.Text) * 10);
  1179. if ((DataTemp > (SpeedSensorThData - 30)) && (DataTemp < (SpeedSensorThData + 30)))
  1180. {
  1181. if (label_sensor_speed.BackColor == Color.Red)
  1182. {
  1183. label_sensor_speed.BackColor = Color.Green;
  1184. label_sensor_speed.Text = "OK";
  1185. OK_cnt++;
  1186. }
  1187. }
  1188. }
  1189. //马达转速
  1190. DataTemp = Convert.ToUInt16(textBox_MotorSpeed.Text);
  1191. if ((DataTemp > (MotorRadeSpeed - 200)) && (DataTemp < (MotorRadeSpeed + 200)))
  1192. {
  1193. if (label_sensor_motor.BackColor == Color.Red)
  1194. {
  1195. label_sensor_motor.BackColor = Color.Green;
  1196. label_sensor_motor.Text = "OK";
  1197. OK_cnt++;
  1198. }
  1199. }
  1200. //母线电压
  1201. DataTemp = Convert.ToUInt16(textBox_Vol.Text);
  1202. if ((DataTemp > (RateVoltage - 1500)) && (DataTemp < (RateVoltage + 1500)))
  1203. {
  1204. if (label_sensor_vol.BackColor == Color.Red)
  1205. {
  1206. label_sensor_vol.BackColor = Color.Green;
  1207. label_sensor_vol.Text = "OK";
  1208. OK_cnt++;
  1209. }
  1210. }
  1211. //母线电流
  1212. DataTemp = Convert.ToUInt16(textBox_Cur.Text);
  1213. if ((DataTemp > No_load_Current - 600) && (DataTemp < No_load_Current + 600))
  1214. {
  1215. if (label_sensor_cur.BackColor == Color.Red)
  1216. {
  1217. label_sensor_cur.BackColor = Color.Green;
  1218. label_sensor_cur.Text = "OK";
  1219. OK_cnt++;
  1220. }
  1221. }
  1222. //踏频
  1223. DataTemp = Convert.ToUInt16(textBox_Cadence.Text);
  1224. if ((DataTemp > (RateCadence - 20)) && (DataTemp < (RateCadence + 20)))
  1225. {
  1226. if (label_sensor_cadence.BackColor == Color.Red)
  1227. {
  1228. label_sensor_cadence.BackColor = Color.Green;
  1229. label_sensor_cadence.Text = "OK";
  1230. OK_cnt++;
  1231. }
  1232. }
  1233. //PCB温度
  1234. DataTemp_Int16 = Convert.ToInt16(textBox_PCB.Text);
  1235. if ((DataTemp_Int16 > -20) && (DataTemp_Int16 < 60))
  1236. {
  1237. if (label_sensor_PCB_temp.BackColor == Color.Red)
  1238. {
  1239. label_sensor_PCB_temp.BackColor = Color.Green;
  1240. label_sensor_PCB_temp.Text = "OK";
  1241. OK_cnt++;
  1242. }
  1243. }
  1244. //绕组温度
  1245. DataTemp_Int16 = Convert.ToInt16(textBox_Coil.Text);
  1246. if ((DataTemp_Int16 > -20) && (DataTemp_Int16 < 60))
  1247. {
  1248. if (label_sensor_coil_temp.BackColor == Color.Red)
  1249. {
  1250. label_sensor_coil_temp.BackColor = Color.Green;
  1251. label_sensor_coil_temp.Text = "OK";
  1252. OK_cnt++;
  1253. }
  1254. }
  1255. //MCU温度
  1256. DataTemp_Int16 = Convert.ToInt16(textBox_MCU.Text);
  1257. if ((DataTemp_Int16 > -20) && (DataTemp_Int16 < 60))
  1258. {
  1259. if (label_sensor_MCU_temp.BackColor == Color.Red)
  1260. {
  1261. label_sensor_MCU_temp.BackColor = Color.Green;
  1262. label_sensor_MCU_temp.Text = "OK";
  1263. OK_cnt++;
  1264. }
  1265. }
  1266. //测试完成,退出
  1267. if (OK_cnt == 8)
  1268. {
  1269. break;
  1270. }
  1271. }
  1272. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "传感器自动检测结束" + "\r\n";
  1273. label_Step.Text = "请在10s内捏下断电开关!";
  1274. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "断电开关检测开始,请捏下断电开关" + "\r\n";
  1275. WalkProcess_Cnt = 0;
  1276. while (WalkProcess_Cnt < 10)//10s内判断电机是否停止
  1277. {
  1278. DataTemp = Convert.ToUInt16(textBox_MotorSpeed.Text);
  1279. if (DataTemp < 100)
  1280. {
  1281. if (label_Sensor_Break.BackColor == Color.Red)
  1282. {
  1283. label_Sensor_Break.BackColor = Color.Green;
  1284. label_Sensor_Break.Text = "OK";
  1285. OK_cnt++;
  1286. }
  1287. break;
  1288. }
  1289. }
  1290. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "断电开关检测结束,请松开断电开关" + "\r\n";
  1291. label_Step.Text = "请松开断电开关!";
  1292. button_Walk.Text = "停止";
  1293. Walk_Process(0x00);
  1294. Delay_ms(1000);
  1295. //判断测试结果
  1296. if (OK_cnt < 9)
  1297. {
  1298. label_Step.Text = "推行测试异常,测试结束!";
  1299. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "推行测试失败,测试结束" + "\r\n";
  1300. button_Start.Enabled = true;
  1301. return;
  1302. }
  1303. #endregion
  1304. #region Step5:转把模式测试(非必需)
  1305. if (GasModeTest == false)
  1306. {
  1307. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "跳过指拨模式测试" + "\r\n";
  1308. label_Sensor_Gas.BackColor = Color.Green;
  1309. label_Sensor_Gas.Text = "OK";
  1310. }
  1311. else
  1312. {
  1313. TestStep = TestStep_Enum.Step_GasMode;
  1314. label_Step.Text = "指拨模式测试,请在10s内转动指拨!";
  1315. button_Walk.Text = "启动";
  1316. Walk_Process(0x04);
  1317. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "指拨模式测试开始,请转动指拨" + "\r\n";
  1318. OK_cnt = 0;
  1319. WalkProcess_Cnt = 0;
  1320. while (WalkProcess_Cnt < 10)//10s内判断电机是否启动
  1321. {
  1322. DataTemp = Convert.ToUInt16(textBox_MotorSpeed.Text);
  1323. if ((DataTemp > (GasModeSpeed - 50)) && (DataTemp < (GasModeSpeed + 50)))
  1324. {
  1325. label_Sensor_Gas.BackColor = Color.Green;
  1326. label_Sensor_Gas.Text = "OK";
  1327. OK_cnt++;
  1328. break;
  1329. }
  1330. }
  1331. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "指拨模式测试结束" + "\r\n";
  1332. Delay_ms(1000);
  1333. button_Walk.Text = "停止";
  1334. Walk_Process(0x00);
  1335. //判断测试结果
  1336. if (OK_cnt < 1)
  1337. {
  1338. label_Step.Text = "指拨模式测试异常,测试结束!";
  1339. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "指拨模式测试失败,测试结束" + "\r\n";
  1340. button_Start.Enabled = true;
  1341. return;
  1342. }
  1343. }
  1344. #endregion
  1345. #region Step6:版本查询和确认
  1346. TestStep = TestStep_Enum.Step_CheckVer;
  1347. label_Step.Text = "版本查询和确认";
  1348. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "发送指令查询版本信息" + "\r\n";
  1349. richTextBox_Ver.Text = "";
  1350. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x1200, null);
  1351. Delay_ms(200);
  1352. SendCmd((ushort)0x651, (byte)0x11, (ushort)0x1200, null);
  1353. Delay_ms(200);
  1354. string FW_Version_Check = comboBox_File.Text.Split('_')[2] + "_" + comboBox_File.Text.Split('_')[3];
  1355. string FW_Version_Result = "";
  1356. string TE_FW_Ver_Check = comboBox_File.Text.Split('_')[4] + "_" + comboBox_File.Text.Split('_')[5];
  1357. string TW_FW_Ver_Result = "";
  1358. FW_Version_Result = richTextBox_Ver.Lines[3].Split(':')[1];
  1359. FW_Version_Result = FW_Version_Result.Split('_')[0] + richTextBox_Ver.Lines[4].Split('-')[2].Replace('V', '.') + "_" + FW_Version_Result.Split('_')[1];
  1360. TW_FW_Ver_Result = richTextBox_Ver.Lines[5].Split(':')[1];
  1361. if ((string.Equals(FW_Version_Check, FW_Version_Result) == true) && (string.Equals(TE_FW_Ver_Check, TW_FW_Ver_Result) == true))
  1362. {
  1363. label_FW_Version.BackColor = Color.Green;
  1364. label_FW_Version.Text = "OK";
  1365. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "版本信息正确" + "\r\n";
  1366. }
  1367. else
  1368. {
  1369. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "版本信息错误" + "\r\n";
  1370. label_Step.Text = "软件版本错误,测试结束!";
  1371. button_Start.Enabled = true;
  1372. return;
  1373. }
  1374. Delay_ms(1000);
  1375. #endregion
  1376. #region Step7:参数查询和保存
  1377. TestStep = TestStep_Enum.Step_Save;
  1378. label_Step.Text = "参数导出";
  1379. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "开始导出电机内部参数" + "\r\n";
  1380. //设置保存路径
  1381. LogSaveFileName = System.IO.Directory.GetCurrentDirectory() + "\\log_" + DateTime.Now.ToString("yyyy-MM-dd").Replace("/", "-") + "\\";
  1382. if (System.IO.Directory.Exists(LogSaveFileName) == false)
  1383. System.IO.Directory.CreateDirectory(LogSaveFileName);
  1384. LogSaveFileName += textBox_PDinfo.Text + "_" + DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss").Replace("/", "-").Replace(":", string.Empty).Replace(" ", "_") + "_ParamsLog" + ".ttlog";
  1385. //开始发送指令
  1386. byte[] SendData = new byte[32];
  1387. //查询校验密钥
  1388. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x1000, null);
  1389. Delay_ms(100);
  1390. //查询版本信息
  1391. //SendCmd((ushort)0x751, (byte)0x11, (ushort)0x1200, null);
  1392. //Delay_ms(100);
  1393. //SendCmd((ushort)0x651, (byte)0x11, (ushort)0x1200, null);
  1394. //Delay_ms(100);
  1395. //查询用户字符串1
  1396. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x1300, null);
  1397. Delay_ms(100);
  1398. //查询用户字符串2
  1399. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x1500, null);
  1400. Delay_ms(100);
  1401. //查询用户字符串3
  1402. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x1700, null);
  1403. Delay_ms(100);
  1404. //查询用户参数1
  1405. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x1A00, null);
  1406. Delay_ms(100);
  1407. //查询马达参数
  1408. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x1C00, null);
  1409. Delay_ms(100);
  1410. //查询历史信息
  1411. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x1E00, null);
  1412. Delay_ms(100);
  1413. //查询生产信息
  1414. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x1F00, null);
  1415. Delay_ms(100);
  1416. //查询力矩传感器零点 Volans
  1417. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x2000, null);
  1418. Delay_ms(100);
  1419. //查询运行信息
  1420. SendData[0] = 0x00;
  1421. SendData[1] = 0xF0;
  1422. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x2802, SendData);
  1423. Delay_ms(100);
  1424. SendData[0] = 0x01;
  1425. SendData[1] = 0xF0;
  1426. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x2802, SendData);
  1427. Delay_ms(100);
  1428. SendData[0] = 0x02;
  1429. SendData[1] = 0xF0;
  1430. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x2802, SendData);
  1431. Delay_ms(100);
  1432. SendData[0] = 0x03;
  1433. SendData[1] = 0xF0;
  1434. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x2802, SendData);
  1435. Delay_ms(100);
  1436. SendData[0] = 0x04;
  1437. SendData[1] = 0xF0;
  1438. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x2802, SendData);
  1439. Delay_ms(100);
  1440. SendData[0] = 0x33;
  1441. SendData[1] = 0xF0;
  1442. SendCmd((ushort)0x751, (byte)0x16, (ushort)0x2802, SendData);
  1443. Delay_ms(100);
  1444. //查询力矩传感器校正信息 Volans
  1445. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x2900, null);
  1446. Delay_ms(100);
  1447. //导出故障日志
  1448. UInt32 Address_Begin;
  1449. UInt32 Addres_End;
  1450. Address_Begin = 0x0801F800;
  1451. Addres_End = 0x0801FBFF;
  1452. UInt32 ReadCount = 0;
  1453. ReadCount = (Addres_End - Address_Begin + 1) / 128;
  1454. for (ushort i = 0; i < ReadCount; i++)
  1455. {
  1456. var SendByte = new byte[8];
  1457. UInt32 Address_Temp_Begin;
  1458. UInt32 Address_Temp_End;
  1459. Address_Temp_Begin = Address_Begin + 128 * (UInt32)i;
  1460. SendByte[0] = (byte)(Address_Temp_Begin >> 24);
  1461. SendByte[1] = (byte)(Address_Temp_Begin >> 16);
  1462. SendByte[2] = (byte)(Address_Temp_Begin >> 8);
  1463. SendByte[3] = (byte)(Address_Temp_Begin);
  1464. Address_Temp_End = Address_Temp_Begin + 127;
  1465. SendByte[4] = (byte)(Address_Temp_End >> 24);
  1466. SendByte[5] = (byte)(Address_Temp_End >> 16);
  1467. SendByte[6] = (byte)(Address_Temp_End >> 8);
  1468. SendByte[7] = (byte)(Address_Temp_End);
  1469. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x2D08, SendByte);
  1470. Delay_ms(100);
  1471. }
  1472. //查询骑行信息
  1473. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x2E00, null);
  1474. Delay_ms(100);
  1475. //查询用户参数2
  1476. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x3000, null);
  1477. Delay_ms(100);
  1478. //查询力矩传感器零点值 Pegasi
  1479. SendData[0] = 1;
  1480. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x3201, SendData);
  1481. Delay_ms(100);
  1482. SendData[0] = 2;
  1483. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x3201, SendData);
  1484. Delay_ms(100);
  1485. SendData[0] = 3;
  1486. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x3201, SendData);
  1487. Delay_ms(100);
  1488. //查询校正系数 Pegasi
  1489. SendData[0] = 1;
  1490. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x3301, SendData);
  1491. Delay_ms(100);
  1492. SendData[0] = 2;
  1493. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x3301, SendData);
  1494. Delay_ms(100);
  1495. SendData[0] = 3;
  1496. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x3301, SendData);
  1497. Delay_ms(100);
  1498. //查询启动值 Pegasi
  1499. SendCmd((ushort)0x751, (byte)0x11, (ushort)0x3500, null);
  1500. Delay_ms(100);
  1501. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "电机参数导出完成" + "\r\n";
  1502. #endregion
  1503. //显示测试结果
  1504. label_Result.BackColor = Color.Green;
  1505. label_Result.Text = "合格";
  1506. label_Step.Text = "合格,测试结束!";
  1507. label_Step.ForeColor = Color.Green;
  1508. richTextBox_TestRecord.Text += DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss") + "->" + "合格,测试结束" + "\r\n";
  1509. button_Start.Enabled = true;
  1510. //保存测试信息
  1511. //页面存储
  1512. Bitmap bit = new Bitmap(this.Width, this.Height);//实例化一个和窗体一样大的bitmap
  1513. Graphics g = Graphics.FromImage(bit);
  1514. g.CopyFromScreen(this.Left, this.Top, 0, 0, new Size(this.Width, this.Height));//保存整个窗体为图片
  1515. LogSaveFileName = System.IO.Directory.GetCurrentDirectory() + "\\log_" + DateTime.Now.ToString("yyyy-MM-dd").Replace("/", "-") + "\\";
  1516. if (System.IO.Directory.Exists(LogSaveFileName) == false)
  1517. System.IO.Directory.CreateDirectory(LogSaveFileName);
  1518. LogSaveFileName += textBox_PDinfo.Text + "_" + DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss").Replace("/", "-").Replace(":", string.Empty).Replace(" ", "_") + "_测试记录" + ".png";
  1519. bit.Save(LogSaveFileName);
  1520. //保存测试记录
  1521. LogSaveFileName = System.IO.Directory.GetCurrentDirectory() + "\\log_" + DateTime.Now.ToString("yyyy-MM-dd").Replace("/", "-") + "\\";
  1522. if (System.IO.Directory.Exists(LogSaveFileName) == false)
  1523. System.IO.Directory.CreateDirectory(LogSaveFileName);
  1524. LogSaveFileName += textBox_PDinfo.Text + "_" + DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss").Replace("/", "-").Replace(":", string.Empty).Replace(" ", "_") + "_测试记录" + ".txt";
  1525. richTextBox_TestRecord.SaveFile(LogSaveFileName, RichTextBoxStreamType.PlainText);
  1526. }
  1527. //开始测试
  1528. private void button_Start_Click(object sender, EventArgs e)
  1529. {
  1530. //标签初始化
  1531. label_Init();
  1532. if (!portsettings_form.serialPort1.IsOpen)
  1533. {
  1534. label_Step.Text = "串口未连接!";
  1535. return;
  1536. }
  1537. #region 检查配置文件
  1538. if (comboBox_File.Items.Count == 0) //配置文件目录为空
  1539. {
  1540. label_Step.Text = "无可用配置文件!";
  1541. return;
  1542. }
  1543. if (comboBox_File.Text.Trim().Length == 0)//未选择配置文件
  1544. {
  1545. label_Step.Text = "请选择配置文件!";
  1546. return;
  1547. }
  1548. #endregion
  1549. #region 检查产品信息是否符合格式要求
  1550. if ((textBox_PDinfo.Text.Contains("%#") || textBox_PDinfo.Text.Contains(" ")) == false)
  1551. {
  1552. label_Step.Text = "打标信息错误!";
  1553. return;
  1554. }
  1555. #endregion
  1556. //测试状态更新
  1557. TestStep = TestStep_Enum.Step_Init;
  1558. label_Step.Text = "准备开始测试";
  1559. label_Step.ForeColor = Color.Red;
  1560. Delay_ms(500);
  1561. //流水号累加和存储
  1562. label_SerialNum.Text = (Convert.ToInt32(label_SerialNum.Text) + 1).ToString();
  1563. string cfg_file = System.IO.Directory.GetCurrentDirectory() + "\\SerialNum";
  1564. StreamReader objReader = new StreamReader(cfg_file);
  1565. string sLine = "";
  1566. ArrayList arrText = new ArrayList();//创建一个动态数组
  1567. while (sLine != null)
  1568. {
  1569. sLine = objReader.ReadLine();
  1570. arrText.Add(sLine);
  1571. }
  1572. arrText.RemoveAt(arrText.Count - 1);
  1573. objReader.Close();
  1574. arrText[1] = label_SerialNum.Text;
  1575. using (StreamWriter file = new StreamWriter(cfg_file))
  1576. {
  1577. foreach (var entry in arrText)
  1578. {
  1579. file.WriteLine(entry);
  1580. }
  1581. }
  1582. button_Start.Enabled = false;
  1583. //创建线程,执行测试任务
  1584. Thread th = new Thread(Thread_Task);
  1585. th.Start();
  1586. }
  1587. //1s计时
  1588. private void timer2_Tick(object sender, EventArgs e)
  1589. {
  1590. label_SystemTime.Text = DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss");
  1591. //MC故障信息超时清除
  1592. if (MC_ErrorCode_Refresh == false)
  1593. {
  1594. MC_ErrorCode_Refresh_Cnt++;
  1595. if (MC_ErrorCode_Refresh_Cnt > 5)
  1596. {
  1597. label_error_code.Text = "OK";
  1598. label_error_code.BackColor = Color.Green;
  1599. label_ErrorInfo.Text = "无故障";
  1600. label_ErrorInfo.ForeColor = Color.Green;
  1601. MC_ErrorCode_Refresh_Cnt = 0;
  1602. }
  1603. }
  1604. else
  1605. {
  1606. MC_ErrorCode_Refresh_Cnt = 0;
  1607. }
  1608. MC_ErrorCode_Refresh = false;
  1609. //MC_RunInfo超时清除
  1610. if (MC_RunInfo_Refresh == false)
  1611. {
  1612. MC_RunInfo_Refresh_Cnt++;
  1613. if (MC_RunInfo_Refresh_Cnt > 5)
  1614. {
  1615. MC_RunInfo_Clear();
  1616. MC_RunInfo_Refresh_Cnt = 0;
  1617. }
  1618. }
  1619. else
  1620. {
  1621. MC_RunInfo_Refresh_Cnt = 0;
  1622. }
  1623. MC_RunInfo_Refresh = false;
  1624. //等待反馈指令
  1625. if (Ack_Flag == false)
  1626. {
  1627. Ack_Cnt++;
  1628. if (Ack_Cnt > 2)
  1629. {
  1630. Ack_Flag = true;
  1631. StepTestFlag = StepTestResult_Enum.StepTestResult_Fail;
  1632. }
  1633. }
  1634. //推行测试计时
  1635. if ((TestStep == TestStep_Enum.Step_Walk) || (TestStep == TestStep_Enum.Step_GasMode))
  1636. {
  1637. WalkProcess_Cnt++;
  1638. }
  1639. }
  1640. //打开系统开关
  1641. private void 开ToolStripMenuItem_Click(object sender, EventArgs e)
  1642. {
  1643. byte[] Data = new byte[1];
  1644. if (portsettings_form.serialPort1.IsOpen)
  1645. {
  1646. //开机
  1647. Data[0] = 0xF1;
  1648. SendCmd(0x7FF, 0x16, 0x2201, Data);
  1649. 开ToolStripMenuItem.Checked = true;
  1650. 关ToolStripMenuItem.Checked = false;
  1651. }
  1652. else
  1653. {
  1654. MessageBox.Show("串口未连接");
  1655. return;
  1656. }
  1657. }
  1658. //关闭系统开关
  1659. private void 关ToolStripMenuItem_Click(object sender, EventArgs e)
  1660. {
  1661. byte[] Data = new byte[1];
  1662. if (portsettings_form.serialPort1.IsOpen)
  1663. {
  1664. //关机
  1665. Data[0] = 0xF0;
  1666. SendCmd(0x7FF, 0x16, 0x2201, Data);
  1667. 开ToolStripMenuItem.Checked = false;
  1668. 关ToolStripMenuItem.Checked = true;
  1669. }
  1670. else
  1671. {
  1672. MessageBox.Show("串口未连接");
  1673. return;
  1674. }
  1675. }
  1676. //查看选定的配置文件
  1677. private void button_CheckCfg_Click(object sender, EventArgs e)
  1678. {
  1679. if (button_CheckCfg.Text == "查看")
  1680. {
  1681. if (comboBox_File.Items.Count == 0) //配置文件目录为空
  1682. {
  1683. MessageBox.Show("无可用配置文件!", "", MessageBoxButtons.OK, MessageBoxIcon.Warning);
  1684. return;
  1685. }
  1686. if (comboBox_File.Text.Trim().Length == 0)//未选择配置文件
  1687. {
  1688. MessageBox.Show("请选择配置文件!", "", MessageBoxButtons.OK, MessageBoxIcon.Warning);
  1689. return;
  1690. }
  1691. richTextBox_Cfg.Visible = true;
  1692. richTextBox_Cfg.Text = "";
  1693. button_CheckCfg.Text = "隐藏";
  1694. this.Size = new Size(this.Size.Width + 280, this.Size.Height);
  1695. //显示文件
  1696. string SelectFile = comboBox_File.SelectedItem.ToString();
  1697. StreamReader objReader = new StreamReader(CfgFilePath + "\\" + SelectFile);
  1698. string sLine = "";
  1699. ArrayList arrText = new ArrayList();//创建一个动态数组
  1700. while (sLine != null)
  1701. {
  1702. sLine = objReader.ReadLine();
  1703. arrText.Add(sLine);
  1704. }
  1705. objReader.Close();
  1706. foreach (string sOutput in arrText)
  1707. {
  1708. richTextBox_Cfg.Text += sOutput + "\r\n";
  1709. }
  1710. }
  1711. else
  1712. {
  1713. richTextBox_Cfg.Visible = false;
  1714. richTextBox_Cfg.Text = "";
  1715. button_CheckCfg.Text = "查看";
  1716. this.Size = new Size(this.Size.Width - 280, this.Size.Height);
  1717. }
  1718. }
  1719. //清除流水号
  1720. private void label8_DoubleClick(object sender, EventArgs e)
  1721. {
  1722. //流水号清零
  1723. if (MessageBox.Show("流水号清零", "确认清零?", MessageBoxButtons.YesNo, MessageBoxIcon.Question) == DialogResult.Yes)
  1724. {
  1725. label_SerialNum.Text = "0";
  1726. //存储
  1727. string cfg_file = System.IO.Directory.GetCurrentDirectory() + "\\SerialNum";
  1728. StreamReader objReader = new StreamReader(cfg_file);
  1729. string sLine = "";
  1730. ArrayList arrText = new ArrayList();//创建一个动态数组
  1731. while (sLine != null)
  1732. {
  1733. sLine = objReader.ReadLine();
  1734. arrText.Add(sLine);
  1735. }
  1736. arrText.RemoveAt(arrText.Count - 1);
  1737. objReader.Close();
  1738. arrText[1] = label_SerialNum.Text;
  1739. using (StreamWriter file = new StreamWriter(cfg_file))
  1740. {
  1741. foreach (var entry in arrText)
  1742. {
  1743. file.WriteLine(entry);
  1744. }
  1745. }
  1746. }
  1747. }
  1748. private void comboBox_File_SelectionChangeCommitted(object sender, EventArgs e)
  1749. {
  1750. //清空原来数据
  1751. array_CfgInfo.Clear();
  1752. //打开选中文件
  1753. string SelectFile = comboBox_File.SelectedItem.ToString();
  1754. StreamReader objReader = new StreamReader(CfgFilePath + "\\" + SelectFile);
  1755. string sLine = "";
  1756. while (sLine != null)
  1757. {
  1758. sLine = objReader.ReadLine();
  1759. array_CfgInfo.Add(sLine);
  1760. }
  1761. //更新推行模式测试判断标准
  1762. MotorRadeSpeed = Convert.ToUInt16(array_CfgInfo[40].ToString().Split(',')[1]);
  1763. RateCadence = (ushort)(MotorRadeSpeed / 11U);
  1764. RateVoltage = (ushort)(Convert.ToByte(array_CfgInfo[45].ToString().Split(',')[1]) * 1000);
  1765. //更新指拨和速度传感器测试标志
  1766. byte temp = Convert.ToByte(array_CfgInfo[25].ToString().Split(',')[1]);
  1767. GasModeTest = temp == 0x55 ? false : temp == 0xAA ? true : false;
  1768. temp = Convert.ToByte(array_CfgInfo[26].ToString().Split(',')[1]);
  1769. SpeedSensorTest = temp == 0x55 || (temp == 0xAA ? false : temp == 0xEE ? false : false);
  1770. //更新空载电流和车速传感器判断阈值
  1771. if (array_CfgInfo.Count > 56)//旧版本无改配置项,采用默认值
  1772. {
  1773. No_load_Current = Convert.ToUInt16(array_CfgInfo[57].ToString().Split(',')[1]);
  1774. SpeedSensorThData = Convert.ToUInt16(array_CfgInfo[58].ToString().Split(',')[1]);
  1775. GasModeSpeed = Convert.ToUInt16(array_CfgInfo[59].ToString().Split(',')[1]);
  1776. }
  1777. objReader.Close();
  1778. }
  1779. private void richTextBox_TestRecord_TextChanged(object sender, EventArgs e)
  1780. {
  1781. richTextBox_TestRecord.SelectionStart = richTextBox_TestRecord.Text.Length;
  1782. richTextBox_TestRecord.ScrollToCaret();
  1783. }
  1784. }
  1785. }