ProtocolModbus.cpp 5.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299
  1. // ProtocolPMC916.cpp: implementation of the CProtocolModbus class.
  2. //
  3. //////////////////////////////////////////////////////////////////////
  4. #include "stdafx.h"
  5. #include "ProtocolModbus.h"
  6. #include "winsock2.h"
  7. #include "Upskehua.h"
  8. #ifdef _DEBUG
  9. #undef THIS_FILE
  10. static char THIS_FILE[]=__FILE__;
  11. #define new DEBUG_NEW
  12. #endif
  13. //////////////////////////////////////////////////////////////////////
  14. // Construction/Destruction
  15. //////////////////////////////////////////////////////////////////////
  16. CProtocolModbus::CProtocolModbus() : CProtocol()
  17. {
  18. InitializeCriticalSection( &m_csReadFinished );
  19. InitializeCriticalSection( &m_csWrFinished );
  20. MTVERIFY( m_hSemComm = CreateEvent( NULL, TRUE, TRUE, "DLL_UPS_KE_HUA" ) );
  21. }
  22. CProtocolModbus::~CProtocolModbus()
  23. {
  24. DeleteCriticalSection( &m_csReadFinished );
  25. DeleteCriticalSection( &m_csWrFinished );
  26. MTVERIFY( CloseHandle( m_hSemComm ) );
  27. }
  28. int CProtocolModbus::WorkMain( int nCommPort,
  29. int nAddr,
  30. char szCmd[32],
  31. char chSendMsg[32],
  32. int nDataLen,
  33. char chMsg[UPS_KE_HUA_MAX_MSG])
  34. {
  35. if(!m_pComm)
  36. return ERR_CODE_UPSKEHUA_COM_FAULT; // 串口通信故障
  37. int nRet;
  38. nRet = RequestStatus(chSendMsg);
  39. if( nRet != 0 )
  40. {
  41. return nRet; // 串口忙
  42. }
  43. nRet = ResponseStatus(szCmd, nDataLen, chMsg);
  44. return nRet;
  45. }
  46. int CProtocolModbus::ResponseStatus(char szCmd[32], int nDataLen, char chMsg[UPS_KE_HUA_MAX_MSG])
  47. {
  48. int nLen = 0;
  49. int nProcessLen = 0;
  50. int nReadLen = 0;
  51. RESPONSE_STRUCT structResponse;
  52. nLen = sizeof(RESPONSE_STRUCT);
  53. memset( &structResponse, 0, nLen );
  54. if (nDataLen <= 0)
  55. {
  56. TRACE("变量长度小于等于0,为非法变量");
  57. return ERR_CODE_UPSKEHUA_COM_VARLEN;
  58. }
  59. char *pBuffer = new char[ nLen ];
  60. memset(pBuffer, 0, nLen);
  61. nReadLen = ReadMessage((BYTE *)pBuffer, nLen);
  62. if( nReadLen <= 0)
  63. {
  64. // 串口没有读到数据
  65. TRACE("串口没有读到数据!\r\n");
  66. SetEvent( m_hSemComm );
  67. if( pBuffer != NULL)
  68. {
  69. delete[] pBuffer;
  70. pBuffer = NULL;
  71. }
  72. return ERR_CODE_UPSKEHUA_COM_READ_NO_DATA;
  73. }
  74. else if( nReadLen < nLen )
  75. {
  76. if (pBuffer[0] == '?')//无效应答包
  77. {
  78. delete[] pBuffer;
  79. pBuffer = NULL;
  80. return ERR_CODE_UPSKEHUA_COM_INVALIDRES;
  81. }
  82. TRACE("长度没有收够,断续接收,止到收完为止!\r\n");
  83. SetEvent( m_hSemComm );
  84. if( pBuffer )
  85. {
  86. delete[] pBuffer;
  87. pBuffer = NULL;
  88. }
  89. return ERR_CODE_UPSKEHUA_COM_FAULT;
  90. }
  91. else if( nReadLen > nLen )
  92. {
  93. // 完全代码,不一定能执行到
  94. TRACE("接收的长度超时所需的长度,认为是非法包,扔掉\r\n");
  95. SetEvent( m_hSemComm );
  96. if( pBuffer != NULL)
  97. {
  98. delete[] pBuffer;
  99. pBuffer = NULL;
  100. }
  101. return ERR_CODE_UPSKEHUA_COM_READ_LEN_OVER;
  102. }
  103. else if(nReadLen == nLen)
  104. {
  105. if (pBuffer[0] == '?')//无效应答包
  106. {
  107. delete[] pBuffer;
  108. pBuffer = NULL;
  109. SetEvent( m_hSemComm );
  110. return ERR_CODE_UPSKEHUA_COM_INVALIDRES;
  111. }
  112. }
  113. EnterCriticalSection( &m_csWrFinished );
  114. memcpy(chMsg, pBuffer + 1, nLen - 1);
  115. LeaveCriticalSection(&m_csWrFinished);
  116. // 设置串口等待事件为有信号
  117. SetEvent( m_hSemComm );
  118. if( pBuffer != NULL)
  119. {
  120. delete[] pBuffer;
  121. pBuffer = NULL;
  122. }
  123. return 0;
  124. }
  125. int CProtocolModbus::RequestStatus(char chSendMsg[32])//
  126. {
  127. if( WaitForSingleObject( m_hSemComm, 0 ) == WAIT_OBJECT_0 ) // 有信号才写串口
  128. {
  129. int nDataLen = strlen(chSendMsg);
  130. ResetEvent( m_hSemComm );
  131. int nResult = WriteMessage((unsigned char *)chSendMsg, nDataLen);
  132. if( nResult == nDataLen )
  133. {
  134. }
  135. else
  136. {
  137. SetEvent( m_hSemComm );
  138. return EER_CODE_UPSKEHUA_COM_REGNUM;
  139. }
  140. }
  141. else
  142. {
  143. return ERR_CODE_UPSKEHUA_COM_BUSY;
  144. }
  145. return 0;
  146. }
  147. BOOL CProtocolModbus::InitParam(PPORTPARAM pPortParam, CCommAsyn *pComm)
  148. {
  149. int addr=pPortParam->StartAddr;
  150. m_pComm=pComm;
  151. return TRUE;
  152. }
  153. int CProtocolModbus:: WriteCommand(char DataBuffer[80], int nDataLen)
  154. {
  155. int iResult = 0;
  156. if(!m_pComm)
  157. return ERR_CODE_UPSKEHUA_COM_FAULT;
  158. iResult = RequestWrStatus(DataBuffer, nDataLen);
  159. if (iResult == 0)
  160. return ResponseWrStatus(DataBuffer, nDataLen);
  161. else
  162. return iResult;
  163. }
  164. int CProtocolModbus::RequestWrStatus( char DataBuffer[80], int nDataLen)//请求写数据
  165. {
  166. if( WaitForSingleObject( m_hSemComm, 0 ) == WAIT_OBJECT_0 ) // 有信号才写串口
  167. {
  168. ResetEvent( m_hSemComm );
  169. int iResult = WriteMessage((unsigned char *)DataBuffer, nDataLen);
  170. if (iResult == nDataLen)
  171. {
  172. return 0;
  173. }
  174. else
  175. {
  176. SetEvent( m_hSemComm );
  177. return EER_CODE_UPSKEHUA_COM_WRITE_DATA;
  178. }
  179. }
  180. else
  181. {
  182. return EER_CODE_UPSKEHUA_COM_WRITE_DATA;
  183. }
  184. }
  185. int CProtocolModbus::ResponseWrStatus( char DataBuffer[80], int nDataLen)
  186. {
  187. char chBuf = 0;
  188. int iReadLen = ReadMessage((BYTE *)&chBuf, sizeof(chBuf));
  189. if( iReadLen <= 0) // 串口没有读到数据
  190. {
  191. SetEvent( m_hSemComm );
  192. return ERR_CODE_UPSKEHUA_COM_READ_NO_DATA;
  193. }
  194. SetEvent( m_hSemComm );
  195. if (chBuf == '>')
  196. {
  197. return 0;
  198. }
  199. else
  200. return ERR_CODE_UPSKEHUA_COM_INVALIDRES;
  201. }
  202. void strReverse( char *str )
  203. {
  204. int l = strlen(str);
  205. for( int i = 0; i < l; i++ )
  206. {
  207. for(int i = 0; i < l; i++)
  208. {
  209. if( str[i] >= 'A' && str[i] <= 'Z' )
  210. {
  211. str[i] += 32;
  212. }
  213. else if(str[i] >= 'a' && str[i] <= 'z')
  214. {
  215. str[i] -= 32;
  216. }
  217. }
  218. }
  219. }
  220. char lowercase2uppercase(BYTE btSrc)
  221. {
  222. if( btSrc >= 'a' && btSrc <= 'z' )
  223. {
  224. return btSrc - 'a' + 'A';
  225. }
  226. return btSrc;
  227. }
  228. char ByteToAscii(BYTE btSrc)
  229. {
  230. char chDest;
  231. if( btSrc < 10 )
  232. {
  233. chDest = (char)(btSrc % 10 + '0');
  234. chDest = lowercase2uppercase(chDest);
  235. return chDest;
  236. }
  237. else
  238. {
  239. chDest = ByteToAscii( btSrc / 10 ) + (char)( btSrc % 10 + '0' );
  240. chDest = lowercase2uppercase(chDest);
  241. return chDest;
  242. }
  243. }
  244. WORD AsciiToBYTE(BYTE btSrc)
  245. {
  246. WORD chDest = (WORD)btSrc;
  247. if ((btSrc >= 'A')&&(btSrc <= 'F'))
  248. {
  249. chDest = chDest - 'A' + 10;
  250. }
  251. else if ((btSrc >= 'a')&&(btSrc <= 'f'))
  252. {
  253. chDest = chDest - 'a' + 10;
  254. }
  255. else if ((btSrc >= '0')&&(btSrc <= '9'))
  256. {
  257. chDest -= '0';
  258. }
  259. return chDest;
  260. }