Uart.c 74 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641
  1. #define __UART_DEF
  2. #include "ABIS_User.h"
  3. /*******************************************************************************
  4. * 函数名称:InitUart1
  5. *******************************************************************************/
  6. void InitUart(void) {
  7. U1MODEbits.STSEL = 0;
  8. U1MODEbits.PDSEL = 0;
  9. U1MODEbits.BRGH = 0;
  10. U1MODEbits.ABAUD = 0;
  11. U1MODEbits.LPBACK = 0;
  12. // U1BRG = 31;
  13. U1BRG = 389;
  14. U1STAbits.UTXISEL0 = 1;
  15. U1STAbits.UTXISEL1 = 0;
  16. U1STAbits.URXISEL = 0;
  17. IEC0bits.U1TXIE = 0;
  18. IEC0bits.U1RXIE = 1;
  19. U1MODEbits.UARTEN = 1;
  20. U1STAbits.UTXEN = 1;
  21. IPC2bits.U1RXIP = 7;
  22. IPC3bits.U1TXIP = 7;
  23. }
  24. /*******************************************************************************
  25. * 函数名称:InitUart2
  26. *******************************************************************************/
  27. void InitUart2(void) {
  28. U2MODEbits.STSEL = 0;
  29. U2MODEbits.PDSEL = 0;
  30. U2MODEbits.BRGH = 0;
  31. U2MODEbits.ABAUD = 0;
  32. U2MODEbits.LPBACK = 0;
  33. // U1BRG = 31;
  34. U2BRG = 389;
  35. U2STAbits.UTXISEL0 = 1;
  36. U2STAbits.UTXISEL1 = 0;
  37. U2STAbits.URXISEL = 0;
  38. IEC1bits.U2TXIE = 0;
  39. IEC1bits.U2RXIE = 1;
  40. U2MODEbits.UARTEN = 1;
  41. U2STAbits.UTXEN = 1;
  42. IPC7bits.U2RXIP = 7;
  43. IPC7bits.U2TXIP = 7;
  44. }
  45. /*******************************************************************************
  46. * 函数名称:InitUart3
  47. *******************************************************************************/
  48. void InitUart3(void) {
  49. U3MODEbits.STSEL = 0;
  50. U3MODEbits.PDSEL = 0;
  51. U3MODEbits.BRGH = 0;
  52. U3MODEbits.ABAUD = 0;
  53. U3MODEbits.LPBACK = 0;
  54. // U1BRG = 31;
  55. U3BRG = 389;
  56. U3STAbits.UTXISEL0 = 1;
  57. U3STAbits.UTXISEL1 = 0;
  58. U3STAbits.URXISEL = 0;
  59. IEC5bits.U3TXIE = 0;
  60. IEC5bits.U3RXIE = 1;
  61. U3MODEbits.UARTEN = 1;
  62. U3STAbits.UTXEN = 1;
  63. IPC20bits.U3RXIP = 7;
  64. IPC20bits.U3TXIP = 7;
  65. }
  66. /*******************************************************************************
  67. * 函数名称:Uart1Send
  68. *******************************************************************************/
  69. void UART1SEND(char data)
  70. {
  71. U1TXREG = data;
  72. while(!IFS0bits.U1TXIF);
  73. IFS0bits.U1TXIF=0;
  74. }
  75. /*******************************************************************************
  76. * 函数名称:_U1RXInterrupt
  77. *******************************************************************************/
  78. void __attribute__((__interrupt__,no_auto_psv)) _U1RXInterrupt(void)
  79. {
  80. IFS0bits.U1RXIF = 0;
  81. g_ucU1RX_Data[g_uiUart1_No] = U1RXREG;
  82. if(g_BUSY1 == 1) return;
  83. if(g_ucHeaderFlag1 == 0){
  84. if(g_ucU1RX_Data[g_uiUart1_No] == FRAME_HEAD){
  85. g_ucHeaderFlag1 = 1;
  86. g_ucU1RX_Data[0] = FRAME_HEAD;
  87. g_uiUart1_No = 1;
  88. }else{
  89. g_BUSY1 = 0;
  90. }
  91. }else if(g_ucHeaderFlag1 == 1){
  92. g_uiUart1_No++;
  93. }
  94. if(g_uiUart1_No > (FRAME_LTHH_INDEX+1)){
  95. g_uiLth1 = g_ucU1RX_Data[FRAME_LTHH_INDEX];
  96. if(g_uiUart1_No == g_uiLth1){
  97. g_ulRSUM1 = Check(g_ucU1RX_Data,g_uiLth1-1);
  98. g_ucCRC1 = (unsigned char)g_ulRSUM1; //
  99. if(g_ucCRC1 == g_ucU1RX_Data[g_uiLth1-1]){
  100. g_ucCMD1 = g_ucU1RX_Data[FRAME_CMD_INDEX];
  101. g_ucUART1_flag = 1;
  102. g_ulRSUM1 = 0;
  103. g_uiUart1_No = 0;
  104. g_ucHeaderFlag1 = 0;
  105. g_BUSY1 = 1;
  106. }else{
  107. memset(g_ucU1RX_Data,0,g_uiLth1*sizeof(unsigned char));
  108. g_BUSY1 = 0;
  109. }
  110. }else if(g_uiUart1_No > g_uiLth1){
  111. g_uiUart1_No = 0;
  112. g_ucHeaderFlag1 = 0;
  113. g_BUSY1 = 0;
  114. }
  115. }
  116. // if(g_ucUART1_flag == 1)
  117. // {
  118. // Uart1_Ack();
  119. // }
  120. }
  121. /*******************************************************************************
  122. * 函数名称:_U2RXInterrupt
  123. *******************************************************************************/
  124. void __attribute__((__interrupt__,no_auto_psv)) _U2RXInterrupt(void)
  125. {
  126. IFS1bits.U2RXIF = 0;
  127. g_ucU1RX_Data[g_uiUart1_No] = U2RXREG;
  128. if(g_BUSY1 == 1) return;
  129. if(g_ucHeaderFlag1 == 0){
  130. if(g_ucU1RX_Data[g_uiUart1_No] == FRAME_HEAD){
  131. g_ucHeaderFlag1 = 1;
  132. g_ucU1RX_Data[0] = FRAME_HEAD;
  133. g_uiUart1_No = 1;
  134. }else{
  135. g_BUSY1 = 0;
  136. }
  137. }else if(g_ucHeaderFlag1 == 1){
  138. g_uiUart1_No++;
  139. }
  140. if(g_uiUart1_No > (FRAME_LTHH_INDEX+1)){
  141. g_uiLth1 = g_ucU1RX_Data[FRAME_LTHH_INDEX];
  142. if(g_uiUart1_No == g_uiLth1){
  143. g_ulRSUM1 = Check(g_ucU1RX_Data,g_uiLth1-1);
  144. g_ucCRC1 = (unsigned char)g_ulRSUM1;
  145. if(g_ucCRC1 == g_ucU1RX_Data[g_uiLth1-1]){
  146. g_ucCMD1 = g_ucU1RX_Data[FRAME_CMD_INDEX];
  147. g_ucUART1_flag = 1;
  148. g_ulRSUM1 = 0;
  149. g_uiUart1_No = 0;
  150. g_ucHeaderFlag1 = 0;
  151. g_BUSY1 = 1;
  152. }else{
  153. memset(g_ucU1RX_Data,0,g_uiLth1*sizeof(unsigned char));
  154. g_BUSY1 = 0;
  155. }
  156. }else if(g_uiUart1_No > g_uiLth1){
  157. g_uiUart1_No = 0;
  158. g_ucHeaderFlag1 = 0;
  159. g_BUSY1 = 0;
  160. }
  161. }
  162. }
  163. /*******************************************************************************
  164. * 函数名称:_U3RXInterrupt
  165. *******************************************************************************/
  166. void __attribute__((__interrupt__,no_auto_psv)) _U3RXInterrupt(void)
  167. {
  168. IFS5bits.U3RXIF = 0;
  169. g_ucU1RX_Data[g_uiUart1_No] = U3RXREG;
  170. if(g_BUSY1 == 1) return;
  171. if(g_ucHeaderFlag1 == 0){
  172. if(g_ucU1RX_Data[g_uiUart1_No] == FRAME_HEAD){
  173. g_ucHeaderFlag1 = 1;
  174. g_ucU1RX_Data[0] = FRAME_HEAD;
  175. g_uiUart1_No = 1;
  176. }else{
  177. g_BUSY1 = 0;
  178. }
  179. }else if(g_ucHeaderFlag1 == 1){
  180. g_uiUart1_No++;
  181. }
  182. if(g_uiUart1_No > (FRAME_LTHH_INDEX+1)){
  183. g_uiLth1 = g_ucU1RX_Data[FRAME_LTHH_INDEX];
  184. if(g_uiUart1_No == g_uiLth1){
  185. g_ulRSUM1 = Check(g_ucU1RX_Data,g_uiLth1-1);
  186. g_ucCRC1 = (unsigned char)g_ulRSUM1; //
  187. if(g_ucCRC1 == g_ucU1RX_Data[g_uiLth1-1]){
  188. g_ucCMD1 = g_ucU1RX_Data[FRAME_CMD_INDEX];
  189. g_ucUART1_flag = 1;
  190. g_ulRSUM1 = 0;
  191. g_uiUart1_No = 0;
  192. g_ucHeaderFlag1 = 0;
  193. g_BUSY1 = 1;
  194. }else{
  195. memset(g_ucU1RX_Data,0,g_uiLth1*sizeof(unsigned char));
  196. g_BUSY1 = 0;
  197. }
  198. }else if(g_uiUart1_No > g_uiLth1){
  199. g_uiUart1_No = 0;
  200. g_ucHeaderFlag1 = 0;
  201. g_BUSY1 = 0;
  202. }
  203. }
  204. }
  205. /*******************************************************************************
  206. * 函数名称:Check
  207. *******************************************************************************/
  208. unsigned int Check(unsigned char *p,unsigned char num)
  209. {
  210. unsigned char i=0;
  211. unsigned int uiCheckSum=0;
  212. for(i=0;i<num;i++){
  213. uiCheckSum += *p;
  214. p++;
  215. }
  216. return uiCheckSum;
  217. }
  218. /*******************************************************************************
  219. * 函数名称:RS1_Ack
  220. *******************************************************************************/
  221. void RS1_Ack(unsigned int sendnum)
  222. {
  223. unsigned int i;
  224. for(i=0;i<sendnum;i++){
  225. UART1SEND(g_ucU1TX_Data[i]);
  226. }
  227. memset(g_ucU1TX_Data,0,sendnum*sizeof(unsigned char));
  228. }
  229. /*******************************************************************************
  230. * 函数名称:Uart1_Ack
  231. *******************************************************************************/
  232. void Uart1_Ack(void)
  233. {
  234. unsigned int g_uiFrmLth;
  235. unsigned int i=0;
  236. unsigned int j=0;
  237. unsigned int n=0;
  238. unsigned long sum;
  239. unsigned char Flag_STATUS=0;
  240. unsigned char Sensor,ucPWMindex,ucCtrlMode;
  241. unsigned int ADC;
  242. long lMPPCtemp = 0;
  243. long lPWMstate=0;
  244. switch(g_ucCMD1){
  245. /***********************(0x01)****************************/
  246. case HELLO:
  247. g_uiFrmLth = 6;
  248. g_ucU1TX_Data[0] = FRAME_HEAD;
  249. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  250. g_ucU1TX_Data[2] = 0;
  251. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  252. g_ucU1TX_Data[4] = Flag_STATUS;
  253. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  254. while(DMA3CONbits.CHEN);
  255. DMA3CNT=(g_uiFrmLth-1);
  256. DMA3CONbits.CHEN = 1;
  257. DMA3REQbits.FORCE = 1;
  258. break;
  259. /*************************(0x02)***************************/
  260. case PCR_SYSRST:
  261. g_uiFrmLth = 6;
  262. g_ucU1TX_Data[0] = FRAME_HEAD;
  263. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  264. g_ucU1TX_Data[2] = 0;
  265. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  266. g_ucU1TX_Data[4] = Flag_STATUS;
  267. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  268. while(DMA3CONbits.CHEN);
  269. DMA3CNT=(g_uiFrmLth-1);
  270. DMA3CONbits.CHEN = 1;
  271. DMA3REQbits.FORCE = 1;
  272. break;
  273. /**********************(0x03)*****************************/
  274. case PCR_SELFTEST:
  275. g_uiFrmLth = 6;
  276. g_ucU1TX_Data[0] = FRAME_HEAD;
  277. g_ucU1TX_Data[1] = g_ucCMD1 | 0X80;
  278. g_ucU1TX_Data[2] = 0;
  279. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  280. g_ucU1TX_Data[4] = 0x00; //
  281. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  282. while(DMA3CONbits.CHEN);
  283. DMA3CNT=(g_uiFrmLth-1);
  284. DMA3CONbits.CHEN = 1;
  285. DMA3REQbits.FORCE = 1;
  286. break;
  287. /**************************(0x04)***************************/
  288. case PCR_DEV:
  289. g_uiFrmLth = 6;
  290. g_ucU1TX_Data[0] = FRAME_HEAD;
  291. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  292. g_ucU1TX_Data[2] = 0;
  293. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  294. g_ucU1TX_Data[4] = Flag_STATUS;
  295. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  296. while(DMA3CONbits.CHEN);
  297. DMA3CNT=(g_uiFrmLth-1);
  298. DMA3CONbits.CHEN = 1;
  299. DMA3REQbits.FORCE = 1;
  300. break;
  301. /*************************(0x05)**************************/
  302. case PCR_STATUS:
  303. g_uiFrmLth = 6;
  304. g_ucU1TX_Data[0] = FRAME_HEAD;
  305. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  306. g_ucU1TX_Data[2] = 0;
  307. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  308. g_ucU1TX_Data[4] = Flag_STATUS;
  309. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  310. while(DMA3CONbits.CHEN);
  311. DMA3CNT=(g_uiFrmLth-1);
  312. DMA3CONbits.CHEN = 1;
  313. DMA3REQbits.FORCE = 1;
  314. break;
  315. /*************************(0x06)**************************/
  316. case SET_Temperature:
  317. if(g_ucU1RX_Data[4] != 0xFF){
  318. ucCtrlMode = 0;
  319. ucCtrlMode = g_ucU1RX_Data[12];
  320. if(ucCtrlMode == 1){
  321. g_ucENABLE = 0;
  322. TempChn[0].cPeltierRun = TempChn[1].cPeltierRun = TempChn[2].cPeltierRun = 0;
  323. TempChn[3].cPeltierRun = 0;
  324. }else{
  325. g_ucENABLE = 1;
  326. Target_temp = g_ucU1RX_Data[4];
  327. Target_temp = (Target_temp<<8) + g_ucU1RX_Data[5];
  328. g_dTarget_temp = (double)Target_temp /100.0;
  329. if(g_dTarget_temp >= 130.0) g_dTarget_temp = 130.0;
  330. if(g_dTarget_temp < 0) g_dTarget_temp = 0;
  331. for (i = 0; i < 4; i++) {
  332. TempChn[i].cBlockTempAriv = 0;
  333. TempChn[i].cPeltierRun = 1;
  334. TempChn[i].fBlockTargetTemp = g_dTarget_temp;
  335. if (fabs(TempChn[i].fCurrentTemperature - g_dTarget_temp) >= 0.3){
  336. ScheduleOperate(i);
  337. }
  338. }
  339. }
  340. }else{
  341. for (i = 0; i < 4; i++) {
  342. TempChn[i].cPeltierRun = 0;
  343. }
  344. }
  345. g_uiFrmLth = 6;
  346. g_ucU1TX_Data[0] = FRAME_HEAD;
  347. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  348. g_ucU1TX_Data[2] = 0;
  349. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  350. g_ucU1TX_Data[4] = Flag_STATUS;
  351. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  352. while(DMA3CONbits.CHEN);
  353. DMA3CNT=(g_uiFrmLth-1);
  354. DMA3CONbits.CHEN = 1;
  355. DMA3REQbits.FORCE = 1;
  356. break;
  357. /***************************(0x78)**************************/
  358. case SET_ZLTemperature:
  359. if(g_ucU1RX_Data[4] != 0xFF){
  360. ucCtrlMode = 0;
  361. ucCtrlMode = g_ucU1RX_Data[12];
  362. if(ucCtrlMode == 1){
  363. g_ucENABLE = 0;
  364. TempChn[4].cPeltierRun = TempChn[5].cPeltierRun = 0;
  365. }else{
  366. g_ucENABLE = 1;
  367. Target_temp = g_ucU1RX_Data[4];
  368. Target_temp = (Target_temp<<8) + g_ucU1RX_Data[5];
  369. g_dTarget_temp = (double)Target_temp /100.0;
  370. if(g_dTarget_temp >= 130.0) g_dTarget_temp = 130.0;
  371. if(g_dTarget_temp < 0) g_dTarget_temp = 0;
  372. for (i = 4; i < 6; i++) {
  373. TempChn[i].cBlockTempAriv = 0;
  374. TempChn[i].cPeltierRun = 1;
  375. TempChn[i].fBlockTargetTemp = g_dTarget_temp;
  376. if (fabs(TempChn[i].fCurrentTemperature - g_dTarget_temp) >= 0.3){
  377. ScheduleOperate(i);
  378. }
  379. }
  380. }
  381. }else{
  382. for (i = 4; i < 6; i++) {
  383. TempChn[i].cPeltierRun = 0;
  384. }
  385. }
  386. g_uiFrmLth = 6;
  387. g_ucU1TX_Data[0] = FRAME_HEAD;
  388. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  389. g_ucU1TX_Data[2] = 0;
  390. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  391. g_ucU1TX_Data[4] = Flag_STATUS;
  392. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  393. while(DMA3CONbits.CHEN);
  394. DMA3CNT=(g_uiFrmLth-1);
  395. DMA3CONbits.CHEN = 1;
  396. DMA3REQbits.FORCE = 1;
  397. break;
  398. /****************************(0x07)*************************/
  399. case PCR_MOTOR:
  400. PCR_MOTOR1 = (g_ucU1RX_Data[4]&0xf0);
  401. PCR_MOTOR2 = g_ucU1RX_Data[4]&0x0f;
  402. if(PCR_MOTOR1 == 0x10 ){
  403. switch(PCR_MOTOR2){
  404. case 6:g_lPulse = g_ucU1RX_Data[5];
  405. g_lPulse = (g_lPulse<<8) + g_ucU1RX_Data[6];
  406. g_lPulse = g_lPulse * 2;
  407. ucMOTOR_DIR = g_ucU1RX_Data[7];
  408. uiSpeed = g_ucU1RX_Data[8];
  409. uiSpeed = (uiSpeed<<8) + g_ucU1RX_Data[9];
  410. MotorXMove(g_lPulse,ucMOTOR_DIR,uiSpeed);
  411. break;
  412. case 7:g_lPulse = g_ucU1RX_Data[5];
  413. g_lPulse = (g_lPulse<<8) + g_ucU1RX_Data[6];
  414. g_lPulse = g_lPulse * 2;
  415. ucMOTOR_DIR = g_ucU1RX_Data[7];
  416. uiSpeed = g_ucU1RX_Data[8];
  417. uiSpeed = (uiSpeed<<8) + g_ucU1RX_Data[9];
  418. MotorXMove(g_lPulse,ucMOTOR_DIR,uiSpeed);
  419. break;
  420. case 3:
  421. MotorXHome(g_tEE.uiXPulseHome,g_tEE.uiXSpeedHome,g_tEE.uiXSpeedLeave);
  422. HangHao=0;
  423. break;
  424. case 10:g_lPulse = g_ucU1RX_Data[5];
  425. g_lPulse = (g_lPulse << 8) + g_ucU1RX_Data[6];
  426. g_lPulse = g_lPulse * 2;
  427. uiSpeed = g_ucU1RX_Data[7];
  428. uiSpeed = (uiSpeed << 8) + g_ucU1RX_Data[8];
  429. MotorXMoveTo(g_lPulse, uiSpeed);
  430. break;
  431. case 5:
  432. g_lPulse = g_ucU1RX_Data[5];
  433. g_lPulse = (g_lPulse << 8) + g_ucU1RX_Data[6];
  434. g_lPulse = g_lPulse * 2;
  435. ucMOTOR_DIR = g_ucU1RX_Data[7];
  436. uiSpeed = g_ucU1RX_Data[8];
  437. uiSpeed = (uiSpeed << 8) + g_ucU1RX_Data[9];
  438. Alldata = 1;
  439. MotorXScan(g_lPulse, ucMOTOR_DIR, uiSpeed);
  440. MotorXMoveTo(0, uiSpeed);
  441. MotorXHome(g_tEE.uiXPulseHome,g_tEE.uiXSpeedHome,g_tEE.uiXSpeedLeave);
  442. // g_uiScanPulseX = 0;
  443. // Alldata = 0;
  444. // IEC1bits.INT2IE = 0;
  445. // //数据处理
  446. //
  447. // for(i=0;i<17;i++){
  448. // ulFAMAD_All = 0;
  449. // ulVICAD_All = 0;
  450. // ulROXAD_All = 0;
  451. // ulCY5AD_All = 0;
  452. // for(j=0;j<SUM1;j++){
  453. // ulFAMAD_All += FAMData[i][j];
  454. // ulVICAD_All += VICData[i][j];
  455. // ulROXAD_All += ROXData[i][j];
  456. // ulCY5AD_All += CY5Data[i][j];
  457. // }
  458. // g_fFAMAD_Max[i] = (float)(ulFAMAD_All/SUM1);
  459. // g_fVICAD_Max[i] = (float)(ulVICAD_All/SUM1);
  460. // g_fROXAD_Max[i] = (float)(ulROXAD_All/SUM1);
  461. // g_fCY5AD_Max[i] = (float)(ulCY5AD_All/SUM1);
  462. // }
  463. // g_fQCFAM_Current = g_fFAMAD_Max[8];
  464. // g_fQCVIC_Current = g_fVICAD_Max[8];
  465. // g_fQCROX_Current = g_fROXAD_Max[8];
  466. // g_fQCCY5_Current = g_fCY5AD_Max[8];
  467. for(i=0;i<17;i++){
  468. ulFAMAD_All = 0;
  469. ulVICAD_All = 0;
  470. ulROXAD_All = 0;
  471. ulCY5AD_All = 0;
  472. Bubble_Sort( &FAMData[i][15], 50);
  473. Bubble_Sort( &VICData[i][15], 50);
  474. Bubble_Sort( &ROXData[i][15], 50);
  475. Bubble_Sort( &CY5Data[i][15], 50);
  476. Bubble_Sort( &CY6Data[i][0], 50);
  477. Bubble_Sort(&_390Data[i][0], 50);
  478. for(j=18;j<(SUM1-18);j++){
  479. ulFAMAD_All += FAMData[i][j];
  480. ulVICAD_All += VICData[i][j];
  481. ulROXAD_All += ROXData[i][j];
  482. ulCY5AD_All += CY5Data[i][j];
  483. }
  484. g_fFAMAD_Max[i] = (float)(ulFAMAD_All/3);
  485. g_fVICAD_Max[i] = (float)(ulVICAD_All/3);
  486. g_fROXAD_Max[i] = (float)(ulROXAD_All/3);
  487. g_fCY5AD_Max[i] = (float)(ulCY5AD_All/3);
  488. }
  489. g_fQCFAM_Current = g_fFAMAD_Max[8];
  490. g_fQCVIC_Current = g_fVICAD_Max[8];
  491. g_fQCROX_Current = g_fROXAD_Max[8];
  492. g_fQCCY5_Current = g_fCY5AD_Max[8];
  493. MotorXMoveTo(0, uiSpeed);
  494. Alldata = 2;
  495. g_uiScanPulseX = 0;
  496. break;
  497. case 11:
  498. Alldata = 0;
  499. DglLedbuf = 0;
  500. FAMLED = 1;
  501. g_lPulse = g_ucU1RX_Data[5];
  502. g_lPulse = (g_lPulse<<8) + g_ucU1RX_Data[6];
  503. g_lPulse = g_lPulse * 2;
  504. ucMOTOR_DIR = g_ucU1RX_Data[7];
  505. uiSpeed = g_ucU1RX_Data[8];
  506. uiSpeed = (uiSpeed<<8) + g_ucU1RX_Data[9];
  507. MotorXScan(g_lPulse,ucMOTOR_DIR,uiSpeed);
  508. Alldata = 2;
  509. FAMLED = 0;
  510. break;
  511. case 12:
  512. DglLedbuf = 0;
  513. Alldata = 0;
  514. VICLED = 1;
  515. g_lPulse = g_ucU1RX_Data[5];
  516. g_lPulse = (g_lPulse<<8) + g_ucU1RX_Data[6];
  517. g_lPulse = g_lPulse * 2;
  518. ucMOTOR_DIR = g_ucU1RX_Data[7];
  519. uiSpeed = g_ucU1RX_Data[8];
  520. uiSpeed = (uiSpeed<<8) + g_ucU1RX_Data[9];
  521. MotorXScan(g_lPulse,ucMOTOR_DIR,uiSpeed);
  522. Alldata = 2;
  523. VICLED = 0;
  524. break;
  525. case 13:
  526. DglLedbuf = 0;
  527. Alldata = 0;
  528. ROXLED = 1;
  529. g_lPulse = g_ucU1RX_Data[5];
  530. g_lPulse = (g_lPulse<<8) + g_ucU1RX_Data[6];
  531. g_lPulse = g_lPulse * 6;
  532. ucMOTOR_DIR = g_ucU1RX_Data[7];
  533. uiSpeed = g_ucU1RX_Data[8];
  534. uiSpeed = (uiSpeed<<8) + g_ucU1RX_Data[9];
  535. MotorXScan(g_lPulse,ucMOTOR_DIR,uiSpeed);
  536. Alldata = 2;
  537. ROXLED = 0;
  538. break;
  539. case 14:
  540. DglLedbuf = 0;
  541. Alldata = 0;
  542. CY5LED = 1;
  543. g_lPulse = g_ucU1RX_Data[5];
  544. g_lPulse = (g_lPulse<<8) + g_ucU1RX_Data[6];
  545. g_lPulse = g_lPulse * 2;
  546. ucMOTOR_DIR = g_ucU1RX_Data[7];
  547. uiSpeed = g_ucU1RX_Data[8];
  548. uiSpeed = (uiSpeed<<8) + g_ucU1RX_Data[9];
  549. MotorXScan(g_lPulse,ucMOTOR_DIR,uiSpeed);
  550. Alldata = 2;
  551. CY5LED = 0;
  552. break;
  553. case 15:
  554. DglLedbuf = 0;
  555. Alldata = 0;
  556. CY6LED = 1;
  557. g_lPulse = g_ucU1RX_Data[5];
  558. g_lPulse = (g_lPulse<<8) + g_ucU1RX_Data[6];
  559. g_lPulse = g_lPulse * 2;
  560. ucMOTOR_DIR = g_ucU1RX_Data[7];
  561. uiSpeed = g_ucU1RX_Data[8];
  562. uiSpeed = (uiSpeed<<8) + g_ucU1RX_Data[9];
  563. MotorXScan(g_lPulse,ucMOTOR_DIR,uiSpeed);
  564. Alldata = 2;
  565. CY6LED = 0;
  566. break;
  567. case 9:
  568. DglLedbuf = 0;
  569. Alldata = 0;
  570. _390LED = 1;
  571. g_lPulse = g_ucU1RX_Data[5];
  572. g_lPulse = (g_lPulse<<8) + g_ucU1RX_Data[6];
  573. g_lPulse = g_lPulse * 2;
  574. ucMOTOR_DIR = g_ucU1RX_Data[7];
  575. uiSpeed = g_ucU1RX_Data[8];
  576. uiSpeed = (uiSpeed<<8) + g_ucU1RX_Data[9];
  577. MotorXScan(g_lPulse,ucMOTOR_DIR,uiSpeed);
  578. Alldata = 2;
  579. _390LED = 0;
  580. break;
  581. default:
  582. break;
  583. }
  584. }
  585. g_uiFrmLth = 6;
  586. g_ucU1TX_Data[0] = FRAME_HEAD;
  587. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  588. g_ucU1TX_Data[2] = 0x00;
  589. g_ucU1TX_Data[3] = g_uiFrmLth;
  590. g_ucU1TX_Data[4] = Flag_STATUS;
  591. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  592. while(DMA3CONbits.CHEN);
  593. DMA3CNT=(g_uiFrmLth-1);
  594. DMA3CONbits.CHEN = 1;
  595. DMA3REQbits.FORCE = 1;
  596. break;
  597. /**************************(0x08)*****************************/
  598. case PCR_LEDCTRL:
  599. switch(g_ucU1RX_Data[4]){
  600. case 1:
  601. CTRLLED1=(g_ucU1RX_Data[5]&0x01)? 1:0;
  602. CTRLLED2=(g_ucU1RX_Data[5]&0x02)? 1:0;
  603. CTRLLED3=(g_ucU1RX_Data[5]&0x04)? 1:0;
  604. CTRLLED4=(g_ucU1RX_Data[5]&0x08)? 1:0;
  605. CTRLLED5=(g_ucU1RX_Data[5]&0x10)? 1:0;
  606. CTRLLED6=(g_ucU1RX_Data[5]&0x20)? 1:0;
  607. break;
  608. case 2:
  609. DglLedbuf=g_ucU1RX_Data[5]&0x3f;
  610. break;
  611. default:
  612. break;
  613. }
  614. g_uiFrmLth = 6;
  615. g_ucU1TX_Data[0] = FRAME_HEAD;
  616. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  617. g_ucU1TX_Data[2] = 0;
  618. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  619. g_ucU1TX_Data[4] = Flag_STATUS;
  620. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  621. while(DMA3CONbits.CHEN);
  622. DMA3CNT=(g_uiFrmLth-1);
  623. DMA3CONbits.CHEN = 1;
  624. DMA3REQbits.FORCE = 1;
  625. break;
  626. /*********************(0x09)*************************/
  627. case PCR_RDTEMP:
  628. g_ucRealTemp_Chanel = g_ucU1RX_Data[4];
  629. switch(g_ucRealTemp_Chanel){
  630. case 0:
  631. // Real_temp[0] = (unsigned int)(TempChn[0].fCurrentTemperature*100.0);
  632. // g_ucRealTemp_Chanel = 0;
  633. break;
  634. case 1:Real_temp[0] = (unsigned int)(TempChn[0].fCurrentTemperature*100.0);
  635. g_ucRealTemp_Chanel = 0;
  636. break;
  637. case 2:Real_temp[1] = (unsigned int)(CAPReal_temp[0]*100.0);
  638. g_ucRealTemp_Chanel = 1;
  639. break;
  640. case 3:Real_temp[2] = (unsigned int)(CAPReal_temp[1]*100.0);
  641. g_ucRealTemp_Chanel = 2;
  642. break;
  643. case 4:Real_temp[3] = (unsigned int)(CAPReal_temp[0] * 100.0);
  644. g_ucRealTemp_Chanel = 3;
  645. break;
  646. case 5:Real_temp[4] = (unsigned int)(g_fFINReal_Temp*100.0);
  647. g_ucRealTemp_Chanel = 4;
  648. break;
  649. case 6:Real_temp[0] = (unsigned int)(TempChn[0].fCurrentTemperature*100.0);
  650. g_ucRealTemp_Chanel = 0;
  651. break;
  652. case 7:Real_temp[0] = (unsigned int)(TempChn[0].fCurrentTemperature*100.0);
  653. g_ucRealTemp_Chanel = 0;
  654. break;
  655. case 8:Real_temp[0] = (unsigned int)(TempChn[0].fCurrentTemperature*100.0);
  656. g_ucRealTemp_Chanel = 0;
  657. break;
  658. default :
  659. break;
  660. }
  661. g_uiFrmLth = 9;
  662. g_ucU1TX_Data[0] = FRAME_HEAD;
  663. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  664. g_ucU1TX_Data[2] = 0;
  665. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;//桢长
  666. g_ucU1TX_Data[4] = Real_temp[g_ucRealTemp_Chanel]>>8;
  667. g_ucU1TX_Data[5] = Real_temp[g_ucRealTemp_Chanel]&0x00ff;
  668. g_ucU1TX_Data[6] = TempChn[g_ucRealTemp_Chanel].cTubeTempAriv;
  669. g_ucU1TX_Data[7] = Flag_STATUS;//状态位
  670. g_ucU1TX_Data[8] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  671. while(DMA3CONbits.CHEN);
  672. DMA3CNT=(g_uiFrmLth-1);
  673. DMA3CONbits.CHEN = 1;
  674. DMA3REQbits.FORCE = 1;
  675. break;
  676. case PCR_RTPCREMP://0x10
  677. g_ucRealTemp_Chanel = g_ucU1RX_Data[4];
  678. g_ucRealTemp_Chanel = 0;
  679. Real_temp[0] = (unsigned int)(TempChn[0].fCurrentTemperature*100.0);
  680. // if((TempChn[0].cTubeTempAriv == 1)||(TempChn[1].cTubeTempAriv == 1)||(TempChn[2].cTubeTempAriv == 1)){
  681. // g_cTubeTempAriv = 1;
  682. // }else{
  683. // g_cTubeTempAriv = 0;
  684. // }
  685. g_uiFrmLth = 9;
  686. g_ucU1TX_Data[0] = FRAME_HEAD;
  687. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  688. g_ucU1TX_Data[2] = 0;
  689. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;//桢长
  690. g_ucU1TX_Data[4] = Real_temp[0]>>8;
  691. g_ucU1TX_Data[5] = Real_temp[0]&0x00ff;
  692. g_ucU1TX_Data[6] =TempChn[0].cTubeTempAriv;
  693. g_ucU1TX_Data[7] = Flag_STATUS; //状态位
  694. g_ucU1TX_Data[8] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  695. while(DMA3CONbits.CHEN);
  696. DMA3CNT=(g_uiFrmLth-1);
  697. DMA3CONbits.CHEN = 1;
  698. DMA3REQbits.FORCE = 1;
  699. break;
  700. /**********************(0x0A)************************/
  701. case PCR_SETCAP://0x0A
  702. CAPPower = g_ucU1RX_Data[4];
  703. CAPPower = (CAPPower<<8) + g_ucU1RX_Data[5];
  704. if(g_ucU1RX_Data[4] == 0xFF){
  705. CAPTarget_temp[0] = g_tEE.CAPTarget_temp[0];
  706. CAPTarget_temp[1] = g_tEE.CAPTarget_temp[1];
  707. }
  708. else {
  709. if(CAPPower < 13000){
  710. CAPTarget_temp[0] = CAPTarget_temp[1] = CAPPower/100;
  711. }else{
  712. }
  713. }
  714. g_uiFrmLth = 6;
  715. g_ucU1TX_Data[0] = FRAME_HEAD;
  716. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  717. g_ucU1TX_Data[2] = 0;
  718. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  719. g_ucU1TX_Data[4] = 0;
  720. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  721. while(DMA3CONbits.CHEN);
  722. DMA3CNT=(g_uiFrmLth-1);
  723. DMA3CONbits.CHEN = 1;
  724. DMA3REQbits.FORCE = 1;
  725. break;
  726. /********************(0x0c)***********************/
  727. case RD_PCRDATA://0x0C
  728. g_ucPCRDATA_Chanel=g_ucU1RX_Data[4];
  729. ucBuffer_Data[0]=((g_ucCMD1|0x80)<<8)+FRAME_HEAD;
  730. ucBuffer_Data[1]=(ZLENTH1<<8)+0;//帧长+CMDNO,
  731. g_ucU1RX_Data[3]=0;
  732. // for(i=0;i<20;i++){
  733. // lMPPCtemp += g_uiMPPCtemp[i];
  734. // }
  735. lMPPCtemp = AD_Get(0x0F);
  736. // if((MPPCALLtemp>60000)||((MPPCALLtemp<100)){
  737. // }
  738. HangHao=0;
  739. //FAM
  740. for(i=0;i<8;i++){
  741. g_fAD_Max[i] = g_fFAMAD_Max[i];
  742. }
  743. for(i=8;i<16;i++){
  744. g_fAD_Max[i] = g_fFAMAD_Max[i+1];
  745. }
  746. for (i = 0; i < 16; i++) {
  747. if (g_tEE.uiQCbuffer == 0) {
  748. g_fAD_Max[i] = g_fAD_Max[i];
  749. } else if (g_tEE.uiQCbuffer == 1) {
  750. if (g_fAD_Max[i] > g_tEE.FAM_MPPCB) {
  751. g_fAD_Max[i] = g_fAD_Max[i] - g_tEE.FAM_MPPCB;
  752. g_fAD_Max[i] = g_fAD_Max[i] / (g_fQCFAM_Current / g_fQCFAM);
  753. g_fAD_Max[i] = g_fAD_Max[i] + g_tEE.FAM_MPPCB;
  754. }else{
  755. g_fAD_Max[i] = g_fAD_Max[i] / (g_fQCFAM_Current / g_fQCFAM);
  756. }
  757. } else if (g_tEE.uiQCbuffer == 2) {
  758. if (g_fAD_Max[i] > g_tEE.FAM_MPPCB) {
  759. g_fAD_Max[i] = g_fAD_Max[i] - g_tEE.FAM_MPPCB;
  760. g_fAD_Max[i] = g_fAD_Max[i] / (g_tEE.FAM_MPPCTk1 * lMPPCtemp * lMPPCtemp + g_tEE.FAM_MPPCTk2 * lMPPCtemp + g_tEE.FAM_MPPCTb1); /*温度补偿*/
  761. g_fAD_Max[i] = g_fAD_Max[i] + g_tEE.FAM_MPPCB;
  762. }else{
  763. g_fAD_Max[i] = g_fAD_Max[i];
  764. }
  765. }else {
  766. }
  767. g_fAD_Max[i] = (g_tEE.fSFAMk[i] * g_fAD_Max[i] + g_tEE.sSFAMb[i]);
  768. if (g_fAD_Max[i] > 60000)g_fAD_Max[i] = 60000;
  769. if (g_fAD_Max[i] < 20)g_fAD_Max[i] = 20;
  770. uiAD_Max[i] = (unsigned int) g_fAD_Max[i];
  771. }
  772. for(GlobalNum1=0;GlobalNum1<16;GlobalNum1++){
  773. ucBuffer_Data[2+ GlobalNum1] = uiAD_Max[GlobalNum1];//帧
  774. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]>>8;
  775. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]&0xff;
  776. }
  777. for(i=0;i<8;i++){
  778. g_fAD_Max[i] = g_fCY5AD_Max[i];
  779. }
  780. for(i=8;i<16;i++){
  781. g_fAD_Max[i] = g_fCY5AD_Max[i+1];
  782. }
  783. for (i = 0; i < 16; i++) {
  784. if (g_tEE.uiQCbuffer == 0) {
  785. g_fAD_Max[i] = g_fAD_Max[i];
  786. }
  787. else if (g_tEE.uiQCbuffer == 1) {
  788. if (g_fAD_Max[i] > g_tEE.CY5_MPPCB) {
  789. g_fAD_Max[i] = g_fAD_Max[i] - g_tEE.CY5_MPPCB;
  790. g_fAD_Max[i] = g_fAD_Max[i] / (g_fQCCY5_Current / g_fQCCY5);
  791. g_fAD_Max[i] = g_fAD_Max[i] + g_tEE.CY5_MPPCB;
  792. }else{
  793. g_fAD_Max[i] = g_fAD_Max[i] / (g_fQCCY5_Current / g_fQCCY5);
  794. }
  795. }
  796. else if (g_tEE.uiQCbuffer == 2) {
  797. if (g_fAD_Max[i] > g_tEE.CY5_MPPCB) {
  798. g_fAD_Max[i] = g_fAD_Max[i] - g_tEE.CY5_MPPCB;
  799. g_fAD_Max[i] = g_fAD_Max[i] / (g_tEE.CY5_MPPCTk1 * lMPPCtemp * lMPPCtemp + g_tEE.CY5_MPPCTk2 * lMPPCtemp + g_tEE.CY5_MPPCTb1);
  800. g_fAD_Max[i] = g_fAD_Max[i] + g_tEE.CY5_MPPCB;
  801. }else{
  802. g_fAD_Max[i] = g_fAD_Max[i];
  803. }
  804. }
  805. else {
  806. }
  807. g_fAD_Max[i] = (g_tEE.fSCY5k[i] * g_fAD_Max[i] + g_tEE.sSCY5b[i]);
  808. if (g_fAD_Max[i] > 60000)g_fAD_Max[i] = 60000;
  809. if (g_fAD_Max[i] < 20)g_fAD_Max[i] = 20;
  810. uiAD_Max[i] = (unsigned int) g_fAD_Max[i];
  811. }
  812. for(GlobalNum1=16;GlobalNum1<32;GlobalNum1++){
  813. ucBuffer_Data[2+GlobalNum1]=uiAD_Max[GlobalNum1-16];//帧
  814. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]>>8;
  815. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]&0xff;
  816. }
  817. for(i=0;i<8;i++){
  818. g_fAD_Max[i] = g_fVICAD_Max[i];
  819. }
  820. for(i=8;i<16;i++){
  821. g_fAD_Max[i] = g_fVICAD_Max[i+1];
  822. }
  823. for (i = 0; i < 16; i++) {
  824. if (g_tEE.uiQCbuffer == 0) {
  825. g_fAD_Max[i] = g_fAD_Max[i];
  826. } else if (g_tEE.uiQCbuffer == 1) {
  827. if (g_fAD_Max[i] > g_tEE.VIC_MPPCB) {
  828. g_fAD_Max[i] = g_fAD_Max[i] - g_tEE.VIC_MPPCB;
  829. g_fAD_Max[i] = g_fAD_Max[i] / (g_fQCVIC_Current / g_fQCVIC);
  830. g_fAD_Max[i] = g_fAD_Max[i] + g_tEE.VIC_MPPCB;
  831. }else{
  832. g_fAD_Max[i] = g_fAD_Max[i] / (g_fQCVIC_Current / g_fQCVIC);
  833. }
  834. } else if (g_tEE.uiQCbuffer == 2) {
  835. if (g_fAD_Max[i] > g_tEE.VIC_MPPCB) {
  836. g_fAD_Max[i] = g_fAD_Max[i] - g_tEE.VIC_MPPCB;
  837. g_fAD_Max[i] = g_fAD_Max[i] / (g_tEE.VIC_MPPCTk1 * lMPPCtemp * lMPPCtemp + g_tEE.VIC_MPPCTk2 * lMPPCtemp + g_tEE.VIC_MPPCTb1);
  838. g_fAD_Max[i] = g_fAD_Max[i] + g_tEE.VIC_MPPCB;
  839. }else{
  840. g_fAD_Max[i] = g_fAD_Max[i];
  841. }
  842. }else {
  843. }
  844. g_fAD_Max[i] = (g_tEE.fSVICk[i] * g_fAD_Max[i] + g_tEE.sSVICb[i]);
  845. if (g_fAD_Max[i] > 60000)g_fAD_Max[i] = 60000;
  846. if (g_fAD_Max[i] < 20)g_fAD_Max[i] = 20;
  847. uiAD_Max[i] = (unsigned int) g_fAD_Max[i];
  848. }
  849. for(GlobalNum1=32;GlobalNum1<48;GlobalNum1++){
  850. ucBuffer_Data[2+GlobalNum1]=uiAD_Max[GlobalNum1-32];//帧
  851. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]>>8;
  852. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]&0xff;
  853. }
  854. for(i=0;i<8;i++){
  855. g_fAD_Max[i] = g_fROXAD_Max[i];
  856. }
  857. for(i=8;i<16;i++){//排序
  858. g_fAD_Max[i] = g_fROXAD_Max[i+1];
  859. }
  860. for (i = 0; i < 16; i++) {
  861. if (g_tEE.uiQCbuffer == 0) {
  862. g_fAD_Max[i] = g_fAD_Max[i];
  863. } else if (g_tEE.uiQCbuffer == 1) {
  864. if (g_fAD_Max[i] > g_tEE.ROX_MPPCB) {
  865. g_fAD_Max[i] = g_fAD_Max[i] - g_tEE.ROX_MPPCB;
  866. g_fAD_Max[i] = g_fAD_Max[i] / (g_fQCROX_Current / g_fQCROX);
  867. g_fAD_Max[i] = g_fAD_Max[i] + g_tEE.ROX_MPPCB;
  868. }else{
  869. g_fAD_Max[i] = g_fAD_Max[i] / (g_fQCROX_Current / g_fQCROX);
  870. }
  871. } else if (g_tEE.uiQCbuffer == 2) {
  872. if (g_fAD_Max[i] > g_tEE.ROX_MPPCB) {
  873. g_fAD_Max[i] = g_fAD_Max[i] - g_tEE.ROX_MPPCB;
  874. g_fAD_Max[i] = g_fAD_Max[i] / (g_tEE.ROX_MPPCTk1 * lMPPCtemp * lMPPCtemp + g_tEE.ROX_MPPCTk2 * lMPPCtemp + g_tEE.ROX_MPPCTb1);
  875. g_fAD_Max[i] = g_fAD_Max[i] + g_tEE.ROX_MPPCB;
  876. }else{
  877. g_fAD_Max[i] = g_fAD_Max[i];
  878. }
  879. }else {
  880. }
  881. g_fAD_Max[i] = (g_tEE.fSROXk[i] * g_fAD_Max[i] + g_tEE.sSROXb[i]);
  882. if (g_fAD_Max[i] > 60000)g_fAD_Max[i] = 60000;
  883. if (g_fAD_Max[i] < 20)g_fAD_Max[i] = 20;
  884. uiAD_Max[i] = (unsigned int) g_fAD_Max[i];
  885. }
  886. for(GlobalNum1=48;GlobalNum1<55;GlobalNum1++){
  887. ucBuffer_Data[2+GlobalNum1]=uiAD_Max[GlobalNum1-48];//帧
  888. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]>>8;
  889. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]&0xff;
  890. }
  891. if(g_ucMPPCtemp == 1){
  892. ucBuffer_Data[57] = (unsigned int)lMPPCtemp;
  893. g_ucU1RX_Data[3] += ucBuffer_Data[57]>>8;
  894. g_ucU1RX_Data[3] += ucBuffer_Data[57]&0xff;
  895. }else{
  896. ucBuffer_Data[57]=uiAD_Max[7];//帧
  897. g_ucU1RX_Data[3] += ucBuffer_Data[57]>>8;
  898. g_ucU1RX_Data[3] += ucBuffer_Data[57]&0xff;
  899. }
  900. for(GlobalNum1=56;GlobalNum1<64;GlobalNum1++){
  901. ucBuffer_Data[2+GlobalNum1]=uiAD_Max[GlobalNum1-48];//帧
  902. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]>>8;
  903. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]&0xff;
  904. }
  905. g_ucU1RX_Data[3] +=ucBuffer_Data[0]>>8;
  906. g_ucU1RX_Data[3] +=ucBuffer_Data[0]&0xff;
  907. g_ucU1RX_Data[3] +=ucBuffer_Data[1]>>8;
  908. g_ucU1RX_Data[3] +=ucBuffer_Data[1]&0xff;
  909. ucBuffer_Data[GlobalNum1+2]=g_ucU1RX_Data[3]<<8;
  910. memset( uiAD_Max,0,16*sizeof(unsigned int));
  911. while(DMA1CONbits.CHEN);
  912. DMA1CNT=(ucBuffer_Data[1]>>8)-1;
  913. DMA1CONbits.CHEN=1;
  914. DMA1REQbits.FORCE =1;
  915. break;
  916. /***********************0x0d)******************************/
  917. case PCR_PMT:
  918. MPPCPower = g_ucU1RX_Data[4];
  919. MPPCPower = (MPPCPower<<8) + g_ucU1RX_Data[5];
  920. Write_DAC(DA_FAM);
  921. Delay_ms(10);
  922. Write_DAC(DA_FAM);
  923. g_uiFrmLth = 6;
  924. g_ucU1TX_Data[0] = FRAME_HEAD;
  925. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  926. g_ucU1TX_Data[2] = 0;
  927. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  928. g_ucU1TX_Data[4] = Flag_STATUS; //状态位
  929. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  930. while(DMA3CONbits.CHEN);
  931. DMA3CNT=(g_uiFrmLth-1);
  932. DMA3CONbits.CHEN = 1;
  933. DMA3REQbits.FORCE = 1;
  934. break;
  935. /**********************(0x0f)***********************/
  936. case PCR_STALED:
  937. g_ucSTATE_RUN = g_ucU1RX_Data[4];
  938. if(g_ucSTATE_RUN == 2){
  939. CAPTarget_temp[0] = CAPTarget_temp[1] = g_tEE.CAPTemp_PCR;
  940. //
  941. // IEC1bits.INT2IE = 1;
  942. Alldata = 1;
  943. MotorXScan(g_tEE.uiXPulseScan * 2, 1, g_tEE.uiXSpeedScan);
  944. MotorXMoveTo(0, uiSpeed);
  945. MotorXHome(g_tEE.uiXPulseHome,g_tEE.uiXSpeedHome,g_tEE.uiXSpeedLeave);
  946. Alldata = 2;
  947. ulAD_Max = 0;
  948. Bubble_Sort( &FAMData[8][15], 50);
  949. for(j=18;j<(SUM1-18);j++){
  950. ulAD_Max += FAMData[8][j];
  951. }
  952. g_fQCFAM = (float)(ulAD_Max/3);
  953. if(g_fQCFAM<100)g_fQCFAM = 100;
  954. if(g_fQCFAM>60000)g_fQCFAM = 60000;
  955. ulAD_Max = 0;
  956. Bubble_Sort( &VICData[8][15], 50);
  957. for(j=18;j<(SUM1-18);j++){
  958. ulAD_Max += VICData[8][j];
  959. }
  960. g_fQCVIC = (float)(ulAD_Max/3);
  961. if(g_fQCVIC<100)g_fQCVIC = 100;
  962. if(g_fQCVIC>60000)g_fQCVIC = 60000;
  963. ulAD_Max = 0;
  964. Bubble_Sort( &ROXData[8][15], 50);
  965. for(j=18;j<(SUM1-18);j++){
  966. ulAD_Max += ROXData[8][j];
  967. }
  968. g_fQCROX = (float)(ulAD_Max/3);
  969. if(g_fQCROX<100)g_fQCROX = 100;
  970. if(g_fQCROX>60000)g_fQCROX = 60000;
  971. ulAD_Max = 0;
  972. Bubble_Sort( &CY5Data[8][15], 50);
  973. for(j=18;j<(SUM1-18);j++){
  974. ulAD_Max += CY5Data[8][j];
  975. }
  976. g_fQCCY5 = (float)(ulAD_Max/3);
  977. if(g_fQCCY5<100)g_fQCCY5 = 100;
  978. if(g_fQCCY5>60000)g_fQCCY5 = 60000;
  979. ulAD_Max = 0;
  980. Bubble_Sort( &CY6Data[8][15], 50);
  981. for(j=18;j<(SUM1-18);j++){
  982. ulAD_Max += CY6Data[8][j];
  983. }
  984. g_fQCCY6 = (float)(ulAD_Max/3);
  985. if(g_fQCCY6<100)g_fQCCY6 = 100;
  986. if(g_fQCCY6>60000)g_fQCCY6 = 60000;
  987. }
  988. else if(g_ucSTATE_RUN == 1){
  989. CAPTarget_temp[0] = g_tEE.CAPTarget_temp[0];
  990. CAPTarget_temp[1] = g_tEE.CAPTarget_temp[1];
  991. if(g_usEERadiatorOvertemp >= 60)g_usEERadiatorOvertemp = 60;
  992. if(g_usEERadiatorOvertemp < 20)g_usEERadiatorOvertemp = 20;
  993. for (i = 0; i < 2; i++) {
  994. TempChn[i].fBlockTargetTemp = g_usEERadiatorOvertemp;
  995. TempChn[i].cPeltierRun = 1;
  996. ScheduleOperate(i);
  997. }
  998. }
  999. g_uiFrmLth = 6;
  1000. g_ucU1TX_Data[0] = FRAME_HEAD;
  1001. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1002. g_ucU1TX_Data[2] = 0;
  1003. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1004. g_ucU1TX_Data[4] = Flag_STATUS; //状态位
  1005. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1006. while(DMA3CONbits.CHEN);
  1007. DMA3CNT=(g_uiFrmLth-1);
  1008. DMA3CONbits.CHEN = 1;
  1009. DMA3REQbits.FORCE = 1;
  1010. break;
  1011. /***************************(0x11)************************/
  1012. case READ_EEPROM:
  1013. uiEE_address = g_ucU1RX_Data[4];
  1014. uiEE_address = (uiEE_address << 8) + g_ucU1RX_Data[5];
  1015. uiEE_address = (uiEE_address << 8) + g_ucU1RX_Data[6];
  1016. GlobalTmp = g_ucU1RX_Data[7];
  1017. for(i=0;i<GlobalTmp;i++){
  1018. g_ucU1TX_Data[FRAME_LTHL_INDEX+i] = EE_read(uiEE_address+i);
  1019. }
  1020. g_uiFrmLth = GlobalTmp+6;
  1021. g_ucU1TX_Data[0] = FRAME_HEAD;
  1022. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1023. g_ucU1TX_Data[2] = 0;//地址
  1024. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1025. g_ucU1TX_Data[g_uiFrmLth-FRAME_STATE_INDEX-1] = Flag_STATUS;
  1026. g_ucU1TX_Data[g_uiFrmLth-FRAME_CRC_INDEX-1] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1027. while(DMA3CONbits.CHEN);
  1028. DMA3CNT=(g_uiFrmLth-1);
  1029. DMA3CONbits.CHEN = 1;
  1030. DMA3REQbits.FORCE = 1;
  1031. break;
  1032. /***************************(0x12)*************************/
  1033. case WRITE_EEPROM:
  1034. uiEE_address = g_ucU1RX_Data[4];
  1035. uiEE_address = (uiEE_address << 8) + g_ucU1RX_Data[5];
  1036. uiEE_address = (uiEE_address << 8) + g_ucU1RX_Data[6];
  1037. if((uiEE_address >= 0x20)&&(uiEE_address < 0x40)){
  1038. }else{
  1039. GlobalTmp = g_ucU1RX_Data[3]-8;
  1040. for(i=0;i<GlobalTmp;i++){
  1041. EE_write(uiEE_address+i,g_ucU1RX_Data[7+i]);
  1042. Delay_ms(10);
  1043. }
  1044. Read_Sys_EE(uiEE_address);
  1045. }
  1046. g_uiFrmLth = 6;
  1047. g_ucU1TX_Data[0] = FRAME_HEAD;
  1048. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1049. g_ucU1TX_Data[2] = 0;
  1050. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1051. g_ucU1TX_Data[4] = Flag_STATUS; //状态标志位
  1052. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1053. while(DMA3CONbits.CHEN);
  1054. DMA3CNT=(g_uiFrmLth-1);
  1055. DMA3CONbits.CHEN = 1;
  1056. DMA3REQbits.FORCE = 1;
  1057. break;
  1058. /**************************(0x15)**********************/
  1059. case PCR_RDSENSOR:
  1060. g_uiFrmLth = 7;
  1061. if(HOMEX==1)Sensor = 1;
  1062. else Sensor = 0;
  1063. g_ucU1TX_Data[0] = FRAME_HEAD;
  1064. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1065. g_ucU1TX_Data[2] = 0;
  1066. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1067. g_ucU1TX_Data[4] = Sensor;
  1068. g_ucU1TX_Data[5] = Flag_STATUS;
  1069. g_ucU1TX_Data[6] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1070. while(DMA3CONbits.CHEN);
  1071. DMA3CNT=(g_uiFrmLth-1);
  1072. DMA3CONbits.CHEN = 1;
  1073. DMA3REQbits.FORCE = 1;
  1074. /**************************(0x18)**********************/
  1075. case GET_MPPCAD:
  1076. memset( uiMppcADBuff,0,6*sizeof(unsigned int));
  1077. uiMppcADBuff[0] = AD_Get(0x09);
  1078. uiMppcADBuff[1] = AD_Get(0x0B);
  1079. uiMppcADBuff[2] = AD_Get(0x0A);
  1080. uiMppcADBuff[3] = AD_Get(0x0C);
  1081. uiMppcADBuff[6] = AD_Get(0x0F);
  1082. g_uiFrmLth = 20;
  1083. g_ucU1TX_Data[0] = FRAME_HEAD;
  1084. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1085. g_ucU1TX_Data[2] = 0;
  1086. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1087. g_ucU1TX_Data[4] = uiMppcADBuff[0] >> 8;
  1088. g_ucU1TX_Data[5] = (unsigned char) uiMppcADBuff[0];
  1089. g_ucU1TX_Data[6] = uiMppcADBuff[1] >> 8;
  1090. g_ucU1TX_Data[7] = (unsigned char) uiMppcADBuff[1];
  1091. g_ucU1TX_Data[8] = uiMppcADBuff[2] >> 8;
  1092. g_ucU1TX_Data[9] = (unsigned char) uiMppcADBuff[2];
  1093. g_ucU1TX_Data[10] = uiMppcADBuff[3] >> 8;
  1094. g_ucU1TX_Data[11] = (unsigned char) uiMppcADBuff[3];
  1095. g_ucU1TX_Data[12] = uiMppcADBuff[4] >> 8;
  1096. g_ucU1TX_Data[13] = (unsigned char) uiMppcADBuff[4];
  1097. g_ucU1TX_Data[14] = uiMppcADBuff[5] >> 8;
  1098. g_ucU1TX_Data[15] = (unsigned char) uiMppcADBuff[5];
  1099. g_ucU1TX_Data[16] = uiMppcADBuff[6] >> 8;
  1100. g_ucU1TX_Data[17] = (unsigned char) uiMppcADBuff[6];
  1101. g_ucU1TX_Data[18] = Flag_STATUS; //状态位
  1102. g_ucU1TX_Data[19] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1103. while(DMA3CONbits.CHEN);
  1104. DMA3CNT=(g_uiFrmLth-1);
  1105. DMA3CONbits.CHEN = 1;
  1106. DMA3REQbits.FORCE = 1;
  1107. break;
  1108. /*************************** (0x18)***********************/
  1109. case PCR_RDADC:
  1110. g_uiFrmLth = 24;
  1111. g_ucU1TX_Data[0] = FRAME_HEAD;
  1112. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1113. g_ucU1TX_Data[2] = 0;
  1114. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1115. g_ucU1TX_Data[4] = dTemperatureAD[0] >> 8;
  1116. g_ucU1TX_Data[5] = (unsigned char) dTemperatureAD[0];
  1117. g_ucU1TX_Data[6] = dTemperatureAD[1] >> 8;
  1118. g_ucU1TX_Data[7] = (unsigned char) dTemperatureAD[1];
  1119. g_ucU1TX_Data[8] = dTemperatureAD[2] >> 8;
  1120. g_ucU1TX_Data[9] = (unsigned char) dTemperatureAD[2];
  1121. g_ucU1TX_Data[10] = dTemperatureAD[3] >> 8;
  1122. g_ucU1TX_Data[11] = (unsigned char) dTemperatureAD[3];
  1123. g_ucU1TX_Data[12] = dTemperatureAD[4] >> 8;
  1124. g_ucU1TX_Data[13] = (unsigned char) dTemperatureAD[4];
  1125. g_ucU1TX_Data[14] = dTemperatureAD[5] >> 8;
  1126. g_ucU1TX_Data[15] = (unsigned char) dTemperatureAD[5];
  1127. g_ucU1TX_Data[16] = dTemperatureAD[6] >> 8;
  1128. g_ucU1TX_Data[17] = (unsigned char) dTemperatureAD[6];
  1129. g_ucU1TX_Data[18] = dTemperatureAD[7] >> 8;
  1130. g_ucU1TX_Data[19] = (unsigned char) dTemperatureAD[7];
  1131. g_ucU1TX_Data[20] = dTemperatureAD[8] >> 8;
  1132. g_ucU1TX_Data[21] = (unsigned char) dTemperatureAD[8];
  1133. g_ucU1TX_Data[22] = Flag_STATUS;
  1134. g_ucU1TX_Data[23] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1135. while(DMA3CONbits.CHEN);
  1136. DMA3CNT=(g_uiFrmLth-1);
  1137. DMA3CONbits.CHEN = 1;
  1138. DMA3REQbits.FORCE = 1;
  1139. break;
  1140. /***************************(0x18)***********************/
  1141. // case ADGET:
  1142. //
  1143. // ADC = AD_Get(g_ucU1RX_Data[4]);
  1144. //
  1145. // g_uiFrmLth = 8;
  1146. // g_ucU1TX_Data[0] = FRAME_HEAD;
  1147. // g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1148. // g_ucU1TX_Data[2] = 0;
  1149. // g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1150. // g_ucU1TX_Data[4] = AD_Get(g_ucU1RX_Data[4]) >> 8;
  1151. // g_ucU1TX_Data[5] = (unsigned char) AD_Get(g_ucU1RX_Data[4]);
  1152. // g_ucU1TX_Data[6] = Flag_STATUS; //状态位
  1153. // g_ucU1TX_Data[7] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1154. // while(DMA3CONbits.CHEN);
  1155. // DMA3CNT=(g_uiFrmLth-1);
  1156. // DMA3CONbits.CHEN = 1;
  1157. // DMA3REQbits.FORCE = 1;
  1158. // break;
  1159. /***************************(0x1C)***********************/
  1160. case PCR_FAN:
  1161. FanCount = g_ucU1RX_Data[4];
  1162. MPPCPower = g_ucU1RX_Data[5];
  1163. MPPCPower = (MPPCPower<<8) + g_ucU1RX_Data[6];
  1164. FANOC_Set(FanCount,MPPCPower);
  1165. g_uiFrmLth = 6;
  1166. g_ucU1TX_Data[0] = FRAME_HEAD;
  1167. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1168. g_ucU1TX_Data[2] = 0;
  1169. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1170. g_ucU1TX_Data[4] = Flag_STATUS; //状态位
  1171. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1172. while(DMA3CONbits.CHEN);
  1173. DMA3CNT=(g_uiFrmLth-1);
  1174. DMA3CONbits.CHEN = 1;
  1175. DMA3REQbits.FORCE = 1;
  1176. break;
  1177. /**************************(0x44)***********************/
  1178. case QC_Data:
  1179. g_uiFrmLth = 14;
  1180. g_ucU1TX_Data[0] = FRAME_HEAD;
  1181. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1182. g_ucU1TX_Data[2] = 0;
  1183. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1184. g_ucU1TX_Data[4] = (unsigned int)g_fQCFAM_Current >> 8;
  1185. g_ucU1TX_Data[5] = (unsigned char) g_fQCFAM_Current;
  1186. g_ucU1TX_Data[6] = (unsigned int)g_fQCVIC_Current >> 8;
  1187. g_ucU1TX_Data[7] = (unsigned char) g_fQCVIC_Current;
  1188. g_ucU1TX_Data[8] = (unsigned int)g_fQCROX_Current >> 8;
  1189. g_ucU1TX_Data[9] = (unsigned char) g_fQCROX_Current;
  1190. g_ucU1TX_Data[10] = (unsigned int)g_fQCCY5_Current >> 8;
  1191. g_ucU1TX_Data[11] = (unsigned char) g_fQCCY5_Current;
  1192. g_ucU1TX_Data[12] = Flag_STATUS; //状态位
  1193. g_ucU1TX_Data[13] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1194. while(DMA3CONbits.CHEN);
  1195. DMA3CNT=(g_uiFrmLth-1);
  1196. DMA3CONbits.CHEN = 1;
  1197. DMA3REQbits.FORCE = 1;
  1198. break;
  1199. /***************************(0x1E)*************************/
  1200. case PCR_IO:
  1201. g_uiFrmLth = 6;
  1202. if(g_ucU1RX_Data[4] == 255){
  1203. g_ucENABLE = 0;
  1204. }else if(g_ucU1RX_Data[4] == 254){
  1205. g_ucENABLE = 1;
  1206. }else{
  1207. SetIO(g_ucU1RX_Data[4],g_ucU1RX_Data[5]);
  1208. }
  1209. g_ucU1TX_Data[0] = FRAME_HEAD;
  1210. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1211. g_ucU1TX_Data[2] = 0;
  1212. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1213. g_ucU1TX_Data[4] = Flag_STATUS; //状态位
  1214. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1215. while(DMA3CONbits.CHEN);
  1216. DMA3CNT=(g_uiFrmLth-1);
  1217. DMA3CONbits.CHEN = 1;
  1218. DMA3REQbits.FORCE = 1;
  1219. if(g_ucU1RX_Data[4] == 253){
  1220. _RP97R = 0x01;
  1221. _U1RXR = 0x70;
  1222. STU2 = 0;
  1223. }
  1224. else if(g_ucU1RX_Data[4] == 252){
  1225. _RP97R = 0x01;
  1226. _U1RXR = 0x60;
  1227. STU2 = 1;
  1228. }
  1229. else{}
  1230. break;
  1231. /*****************************(0xE0)***************************/
  1232. case GET_IO:
  1233. Get_IOstate = Get_IO(g_ucU1RX_Data[4]);
  1234. g_uiFrmLth = 7;
  1235. g_ucU1TX_Data[0] = FRAME_HEAD;
  1236. g_ucU1TX_Data[1] = g_ucCMD1 | 0X80;
  1237. g_ucU1TX_Data[2] = 0;
  1238. g_ucU1TX_Data[3] = g_uiFrmLth; //
  1239. g_ucU1TX_Data[4] = Get_IOstate; //获取的IO状态
  1240. g_ucU1TX_Data[5] = Flag_STATUS; //状态位
  1241. g_ucU1TX_Data[6] = (unsigned char) Check(g_ucU1TX_Data, g_uiFrmLth - 1);
  1242. while (DMA3CONbits.CHEN);
  1243. DMA3CNT = (g_uiFrmLth - 1);
  1244. DMA3CONbits.CHEN = 1;
  1245. DMA3REQbits.FORCE = 1;
  1246. break;
  1247. /************************** (0x31)*************************/
  1248. case SET_PWM:
  1249. ucPWMindex = g_ucU1RX_Data[4];
  1250. lPWMstate = g_ucU1RX_Data[5];
  1251. lPWMstate = (lPWMstate << 8) + g_ucU1RX_Data[6];
  1252. ucCtrlMode = g_ucU1RX_Data[7];
  1253. if (ucCtrlMode == 0) {
  1254. SetPWM(ucPWMindex, lPWMstate);
  1255. } else if (ucCtrlMode == 1) {
  1256. SetPWM(ucPWMindex, -lPWMstate);
  1257. } else {}
  1258. g_uiFrmLth = 6;
  1259. g_ucU1TX_Data[0] = FRAME_HEAD;
  1260. g_ucU1TX_Data[1] = g_ucCMD1 | 0X80;
  1261. g_ucU1TX_Data[2] = 0;
  1262. g_ucU1TX_Data[3] = g_uiFrmLth;
  1263. g_ucU1TX_Data[4] = 0x00; //状态位
  1264. g_ucU1TX_Data[5] = (unsigned char) Check(g_ucU1TX_Data, g_uiFrmLth - 1);
  1265. while(DMA3CONbits.CHEN);
  1266. DMA3CNT=(g_uiFrmLth-1);
  1267. DMA3CONbits.CHEN = 1;
  1268. DMA3REQbits.FORCE = 1;
  1269. break;
  1270. /**************************(0x32)***********************/
  1271. case GET_PWM:
  1272. g_uiFrmLth = 18;
  1273. g_ucU1TX_Data[0] = FRAME_HEAD;
  1274. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1275. g_ucU1TX_Data[2] = 0;
  1276. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1277. g_ucU1TX_Data[4] = g_uiGetPWM[0] >> 8;
  1278. g_ucU1TX_Data[5] = (unsigned char) g_uiGetPWM[0];
  1279. g_ucU1TX_Data[6] = g_uiGetPWM[1] >> 8;
  1280. g_ucU1TX_Data[7] = (unsigned char) g_uiGetPWM[1];
  1281. g_ucU1TX_Data[8] = g_uiGetPWM[2] >> 8;
  1282. g_ucU1TX_Data[9] = (unsigned char) g_uiGetPWM[2];
  1283. g_ucU1TX_Data[10] = g_uiGetPWM[3] >> 8;
  1284. g_ucU1TX_Data[11] = (unsigned char) g_uiGetPWM[3];
  1285. g_ucU1TX_Data[12] = g_uiGetPWM[4] >> 8;
  1286. g_ucU1TX_Data[13] = (unsigned char) g_uiGetPWM[4];
  1287. g_ucU1TX_Data[14] = g_uiGetPWM[5] >> 8;
  1288. g_ucU1TX_Data[15] = (unsigned char) g_uiGetPWM[5];
  1289. g_ucU1TX_Data[16] = Flag_STATUS; //状态位
  1290. g_ucU1TX_Data[17] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1291. while(DMA3CONbits.CHEN);
  1292. DMA3CNT=(g_uiFrmLth-1);
  1293. DMA3CONbits.CHEN = 1;
  1294. DMA3REQbits.FORCE = 1;
  1295. break;
  1296. /********************(0x25)**********************/
  1297. case PCR_TUBEMODE:
  1298. g_uiFrmLth = 6;
  1299. g_ucU1TX_Data[0] = FRAME_HEAD;
  1300. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1301. g_ucU1TX_Data[2] = 0;
  1302. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1303. g_ucU1TX_Data[4] = Flag_STATUS; //状态位
  1304. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1305. while(DMA3CONbits.CHEN);
  1306. DMA3CNT=(g_uiFrmLth-1);
  1307. DMA3CONbits.CHEN = 1;
  1308. DMA3REQbits.FORCE = 1;
  1309. break;
  1310. /**********************(0x26)***************************/
  1311. case PCR_INBOX:
  1312. g_uiFrmLth = 6;
  1313. g_ucU1TX_Data[0] = FRAME_HEAD;
  1314. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1315. g_ucU1TX_Data[2] = 0;
  1316. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1317. g_ucU1TX_Data[4] = 0; //状态位
  1318. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1319. while(DMA3CONbits.CHEN);
  1320. DMA3CNT=(g_uiFrmLth-1);
  1321. DMA3CONbits.CHEN = 1;
  1322. DMA3REQbits.FORCE = 1;
  1323. break;
  1324. /**********************(0x27)***************************/
  1325. case PCR_OUTBOX:
  1326. g_uiFrmLth = 6;
  1327. g_ucU1TX_Data[0] = FRAME_HEAD;
  1328. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1329. g_ucU1TX_Data[2] = 0;
  1330. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1331. g_ucU1TX_Data[4] = 0; //状态位
  1332. g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1333. while(DMA3CONbits.CHEN);
  1334. DMA3CNT=(g_uiFrmLth-1);
  1335. DMA3CONbits.CHEN = 1;
  1336. DMA3REQbits.FORCE = 1;
  1337. break;
  1338. case PCR_TEMP://0x43
  1339. if((TempChn[0].cTubeTempAriv == 1)||(TempChn[1].cTubeTempAriv == 1)||(TempChn[2].cTubeTempAriv == 1)||(TempChn[3].cTubeTempAriv == 1)
  1340. ){
  1341. g_cTubeTempAriv = 1;
  1342. }else{
  1343. g_cTubeTempAriv = 0;
  1344. }
  1345. g_uiFrmLth = 23;
  1346. g_ucU1TX_Data[0] = FRAME_HEAD;
  1347. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1348. g_ucU1TX_Data[2] = 0;
  1349. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1350. g_ucU1TX_Data[4] = (unsigned int)(TempChn[0].fCurrentTemperature*100.0) >> 8;
  1351. g_ucU1TX_Data[5] = (unsigned char) (TempChn[0].fCurrentTemperature*100.0);
  1352. g_ucU1TX_Data[6] = (unsigned int)(TempChn[1].fCurrentTemperature*100.0) >> 8;
  1353. g_ucU1TX_Data[7] = (unsigned char) (TempChn[1].fCurrentTemperature*100.0);
  1354. g_ucU1TX_Data[8] = (unsigned int)(TempChn[2].fCurrentTemperature*100.0) >> 8;
  1355. g_ucU1TX_Data[9] = (unsigned char) (TempChn[2].fCurrentTemperature*100.0);
  1356. g_ucU1TX_Data[10] = (unsigned int)(TempChn[3].fCurrentTemperature*100.0) >> 8;
  1357. g_ucU1TX_Data[11] = (unsigned char) (TempChn[3].fCurrentTemperature*100.0);
  1358. g_ucU1TX_Data[12] = (unsigned int)(TempChn[4].fCurrentTemperature*100.0) >> 8;
  1359. g_ucU1TX_Data[13] = (unsigned char) (TempChn[4].fCurrentTemperature*100.0);
  1360. g_ucU1TX_Data[14] = (unsigned int)(TempChn[5].fCurrentTemperature*100.0) >> 8;
  1361. g_ucU1TX_Data[15] = (unsigned char) (TempChn[5].fCurrentTemperature*100.0);
  1362. g_ucU1TX_Data[16] = (unsigned int)(TempChn[5].fCurrentTemperature*100.0) >> 8;
  1363. g_ucU1TX_Data[17] = (unsigned char) (TempChn[5].fCurrentTemperature*100.0);
  1364. g_ucU1TX_Data[18] = (unsigned int)(TempChn[5].fCurrentTemperature*100.0) >> 8;
  1365. g_ucU1TX_Data[19] = (unsigned char) (TempChn[5].fCurrentTemperature*100.0);
  1366. g_ucU1TX_Data[20] = g_cTubeTempAriv;
  1367. g_ucU1TX_Data[21] = Flag_STATUS; //状态位
  1368. g_ucU1TX_Data[22] = (unsigned char) Check(g_ucU1TX_Data, g_uiFrmLth - 1);
  1369. while(DMA3CONbits.CHEN);
  1370. DMA3CNT=(g_uiFrmLth-1);
  1371. DMA3CONbits.CHEN = 1;
  1372. DMA3REQbits.FORCE = 1;
  1373. break;
  1374. /***************(0x28)*********************/
  1375. case PCR_STATEBIT://0x28
  1376. g_uiFrmLth = 8;
  1377. g_ucU1TX_Data[0] = FRAME_HEAD;
  1378. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1379. g_ucU1TX_Data[2] = 0;
  1380. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1381. g_ucU1TX_Data[4] = 0x00;
  1382. g_ucU1TX_Data[5] = 0x00;
  1383. g_ucU1TX_Data[6] = Flag_STATUS; //状态位
  1384. g_ucU1TX_Data[7] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1385. while(DMA3CONbits.CHEN);
  1386. DMA3CNT=(g_uiFrmLth-1);
  1387. DMA3CONbits.CHEN = 1;
  1388. DMA3REQbits.FORCE = 1;
  1389. break;
  1390. /*********************(0xFF)***********************/
  1391. case RD_PCRALLDATA:
  1392. ucBuffer_Data[0]=((g_ucCMD1|0x80)<<8)+FRAME_HEAD;
  1393. ucBuffer_Data[1]=(ZLENTH2<<8)+0;
  1394. g_ucU1RX_Data[3]=0;
  1395. BTvar.ucScanNum = 0;
  1396. if(g_ucU1RX_Data[4] == 1){
  1397. SampleTransNo = 0;
  1398. for(i = 0;i<6748;i++){
  1399. ucBuffer_Data[i+2] = ((ucBuffer_Data[i+2]<< 8) + (ucBuffer_Data[i+2]>> 8));
  1400. }
  1401. ucBuffer_Data[2] = 0;
  1402. for(GlobalNum1=0;GlobalNum1<(ZLENTH2/2-3);GlobalNum1++){
  1403. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]>>8;
  1404. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]&0xff;
  1405. }
  1406. }
  1407. else {
  1408. SampleTransNo ++;
  1409. for(GlobalNum1=0;GlobalNum1<(ZLENTH2/2-3);GlobalNum1++){
  1410. ucBuffer_Data[2+GlobalNum1]=ucBuffer_Data[SampleTransNo * (ZLENTH2/2-3)+GlobalNum1];//帧
  1411. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]>>8;
  1412. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]&0xff;
  1413. }
  1414. }
  1415. g_ucU1RX_Data[3] +=ucBuffer_Data[0]>>8;
  1416. g_ucU1RX_Data[3] +=ucBuffer_Data[0]&0xff;
  1417. g_ucU1RX_Data[3] +=ucBuffer_Data[1]>>8;
  1418. g_ucU1RX_Data[3] +=ucBuffer_Data[1]&0xff;
  1419. ucBuffer_Data[GlobalNum1+2]=(g_ucU1RX_Data[3]<<8);//低位先发送,错误
  1420. while(DMA1CONbits.CHEN);
  1421. DMA1CNT=(ucBuffer_Data[1]>>8)-1;
  1422. DMA1CONbits.CHEN = 1;
  1423. DMA1REQbits.FORCE = 1;
  1424. break;
  1425. /********************(0xFE)***********************/
  1426. case RD_ALLDATAMAX:
  1427. ucBuffer_Data[0]=((g_ucCMD1|0x80)<<8)+FRAME_HEAD;
  1428. ucBuffer_Data[1]=(ZLENTH2<<8)+0;
  1429. g_ucU1RX_Data[3]=0;
  1430. if(g_ucU1RX_Data[4] == 1){
  1431. SampleTransNo = 0;
  1432. n = 0;
  1433. if(g_ucU1RX_Data[5] == 1){
  1434. for(i = 0;i<17;i++){
  1435. for(j = 0;j<SUM1;j++){
  1436. Alldata_Max[n] = ((FAMData[i][j]<< 8) + (FAMData[i][j]>> 8));
  1437. n++;
  1438. }
  1439. }
  1440. }
  1441. else if(g_ucU1RX_Data[5] == 2){
  1442. for(i = 0;i<17;i++){
  1443. for(j = 0;j<SUM1;j++){
  1444. Alldata_Max[n] = ((VICData[i][j]<< 8) + (VICData[i][j]>> 8));
  1445. n++;
  1446. }
  1447. }
  1448. }
  1449. else if(g_ucU1RX_Data[5] == 3){
  1450. for(i = 0;i<17;i++){
  1451. for(j = 0;j<SUM1;j++){
  1452. Alldata_Max[n] = ((ROXData[i][j]<< 8) + (ROXData[i][j]>> 8));
  1453. n++;
  1454. }
  1455. }
  1456. }
  1457. else if(g_ucU1RX_Data[5] == 4){
  1458. for(i = 0;i<17;i++){
  1459. for(j = 0;j<SUM1;j++){
  1460. Alldata_Max[n] = ((CY5Data[i][j]<< 8) + (CY5Data[i][j]>> 8));
  1461. n++;
  1462. }
  1463. }
  1464. }
  1465. }
  1466. else SampleTransNo ++;
  1467. for(GlobalNum1=0;GlobalNum1<ZLENTH2/2-3;GlobalNum1++){
  1468. ucBuffer_Data[2+GlobalNum1]=Alldata_Max[SampleTransNo * (ZLENTH2/2-3)+GlobalNum1];//帧
  1469. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]>>8;
  1470. g_ucU1RX_Data[3] += ucBuffer_Data[2+GlobalNum1]&0xff;
  1471. }
  1472. g_ucU1RX_Data[3] +=ucBuffer_Data[0]>>8;
  1473. g_ucU1RX_Data[3] +=ucBuffer_Data[0]&0xff;
  1474. g_ucU1RX_Data[3] +=ucBuffer_Data[1]>>8;
  1475. g_ucU1RX_Data[3] +=ucBuffer_Data[1]&0xff;
  1476. ucBuffer_Data[GlobalNum1+2]=(g_ucU1RX_Data[3]<<8);
  1477. while(DMA1CONbits.CHEN);
  1478. DMA1CNT=(ucBuffer_Data[1]>>8)-1;
  1479. DMA1CONbits.CHEN = 1;
  1480. DMA1REQbits.FORCE = 1;
  1481. break;
  1482. /****************(0x66)*********************/
  1483. case BT_Protocol://
  1484. BTvar.ucStepNum = g_ucU1RX_Data[5];
  1485. for (i = 0; i < BTvar.ucStepNum; i++) {
  1486. BTStep[i].Temp_Start = (g_ucU1RX_Data[i * 10 + 6] << 8) + g_ucU1RX_Data[i * 10 + 7];
  1487. BTStep[i].Temp_End = (g_ucU1RX_Data[i * 10 + 8] << 8) + g_ucU1RX_Data[i * 10 + 9];
  1488. BTStep[i].Duration = (g_ucU1RX_Data[i * 10 + 10] << 8) + g_ucU1RX_Data[i * 10 + 11];
  1489. BTStep[i].Cycle = g_ucU1RX_Data[i * 10 + 12];
  1490. if(BTStep[i].Cycle == 0)
  1491. BTStep[i].Mode = g_ucU1RX_Data[i * 10 + 13];
  1492. BTStep[i].Point = g_ucU1RX_Data[i * 10 + 14];
  1493. BTStep[i].Goto = g_ucU1RX_Data[i * 10 + 15];
  1494. }
  1495. BTvar.ucStartbuffer = 1;
  1496. BTvar.ucQCbuffer = 1;
  1497. g_uiFrmLth = 8;
  1498. g_ucU1TX_Data[0] = FRAME_HEAD;
  1499. g_ucU1TX_Data[1] = g_ucCMD1|0X80;
  1500. g_ucU1TX_Data[2] = 0;
  1501. g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
  1502. g_ucU1TX_Data[4] = 0x00;
  1503. g_ucU1TX_Data[5] = 0x00;
  1504. g_ucU1TX_Data[6] = Flag_STATUS; //状态位
  1505. g_ucU1TX_Data[7] = (unsigned char)Check(g_ucU1TX_Data,g_uiFrmLth-1);
  1506. while(DMA3CONbits.CHEN);
  1507. DMA3CNT=(g_uiFrmLth-1);
  1508. DMA3CONbits.CHEN = 1;
  1509. DMA3REQbits.FORCE = 1;
  1510. break;
  1511. default:
  1512. break;
  1513. }
  1514. g_ucUART1_flag = 0;
  1515. g_uiUart1_No = 0;
  1516. g_ucHeaderFlag1 = 0;
  1517. memset(g_ucU1RX_Data,0,g_uiLth1*sizeof(unsigned char));
  1518. g_BUSY1 = 0;
  1519. }