sys_mqtt.c 10.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344
  1. #include "string.h"
  2. #include "stm32f2xx.h"
  3. #include "ucos_ii.h"
  4. #include "hd_eth.h"
  5. #include "lwip/arch.h"
  6. #include "sys_mqtt.h"
  7. #include "transport.h"
  8. #include "MQTTFormat.h"
  9. #include "cJSON.h"
  10. #include "led.h"
  11. #include "MQTTClient.h"
  12. #include "malloc.h"
  13. #include "mmodbus.h"
  14. #include "myFile.h"
  15. #include "gateway_message.h"
  16. #include "task.h"
  17. /********************************************************
  18. * @brief 连接到服务器
  19. * @param sock: sock编号
  20. *********************************************************/
  21. int mqtt_userConnect(void)
  22. {
  23. GATEWAY_PARAMS* get;
  24. get = get_gateway_config_params();
  25. char* MQTT_SERVER_ADDR = get->host;
  26. int MQTT_SERVER_PORT = get->port;
  27. int sock = -1;
  28. //连接到tcp服务器
  29. sock = transport_open(MQTT_SERVER_ADDR, MQTT_SERVER_PORT);
  30. if(sock < 0)
  31. {
  32. MQTT_PRINTF("connect tcp server error \r\n");
  33. return -1;
  34. }
  35. MQTT_PRINTF("connect tcp server success \r\n");
  36. //连接到mqtt服务器
  37. if(mqtt_connectToMqttServer(sock) <= 0)
  38. {
  39. MQTT_PRINTF("connect mqtt server error \r\n");
  40. return -1;
  41. }
  42. MQTT_PRINTF("connect mqtt server success \r\n");
  43. return sock;
  44. }
  45. /************************************************************
  46. * @brief 订阅主题
  47. * @param sock: sock编号
  48. * @retval 1: 订阅成功
  49. *************************************************************/
  50. int mqtt_userSubscribeTopic(int sock)
  51. {
  52. GATEWAY_PARAMS* get;
  53. get = get_gateway_config_params();
  54. char* TOPICPC = (char*)get->commandTopic;
  55. return mqtt_subscribeTopic(sock, TOPICPC, 2);
  56. }
  57. /*
  58. *接收mqtt下发消息并存储进一个数据队列
  59. *name MQTT主题相关信息
  60. */
  61. void *json_message[10];
  62. #define QUEUE_SIZE 10 //队列深度
  63. //消息队列指针
  64. OS_EVENT *JsonQ;
  65. void mqtt_outputMsg(MQTTString *name, uint8_t *msgbuf, int msglen, uint16_t id, int qos)
  66. {
  67. int lenght=msglen;
  68. MQTT_PRINTF("receive a msg: id=%d qos=%d topic=%s msg=%s \r\n", id, qos, name->lenstring.data, msgbuf);
  69. StringInfo message;
  70. message.p=mymalloc(SRAMEX ,msglen);
  71. memcpy(message.p,msgbuf,msglen);
  72. uint8_t err;
  73. err=OSQPost(JsonQ,(void *)&message);
  74. switch(err)
  75. {
  76. case OS_ERR_NONE:
  77. break;
  78. case OS_ERR_Q_FULL:
  79. MQTT_PRINTF("receive a msg queue is full \r\n");
  80. break;
  81. default:
  82. break;
  83. }
  84. }
  85. /************************************************************
  86. * @brief 处理来自平台发布的信息
  87. * @param sock: sock编号
  88. pbuf: 接收的数据
  89. buflen: 数据的长度
  90. * @retval 1: 消息正常处理
  91. * -2: 帧数据包错误
  92. *************************************************************/
  93. int mqtt_recvPublishMessage(int sock, uint8_t *pbuf, int buflen)
  94. {
  95. uint8_t dup, retained;
  96. int qos, payloadlen;
  97. uint16_t packetid;
  98. MQTTString topicName;
  99. uint8_t *payload;
  100. int msg;
  101. if(MQTTDeserialize_publish(&dup, &qos, &retained, &packetid, &topicName, &payload, &payloadlen, pbuf, buflen) == 1)
  102. {
  103. mqtt_outputMsg(&topicName, payload, payloadlen, packetid, qos);
  104. }
  105. else return -2;
  106. if(qos == 1)
  107. {
  108. mqtt_recvPublishQos1_packid = packetid;
  109. msg = MBOX_MQTT_QOS1PUBACK;
  110. OSMboxPost(mqtt_sendMseeageMbox, &msg);
  111. }
  112. if(qos == 2)
  113. {
  114. mqtt_recvPublishQos2_packid = packetid;
  115. msg = MBOX_MQTT_QOS2PUBREC;
  116. OSMboxPost(mqtt_sendMseeageMbox, &msg);
  117. }
  118. return 1;
  119. }
  120. /************************************************************
  121. * @brief 解析所有平台下发的数据包
  122. * @param sock: sock编号
  123. type: 数据帧的类型
  124. pbuf: 数据
  125. buflen: 数据的长度
  126. * @retval 1: 消息正常处理
  127. * -2: 帧数据包错误
  128. *************************************************************/
  129. int mqtt_userReceiveMessage(int sock, int type, uint8_t *pbuf, int len)
  130. {
  131. int rc;
  132. switch(type)
  133. {
  134. case PUBLISH: rc = mqtt_recvPublishMessage(sock, pbuf, len); break; //平台向设备发布消息
  135. case PUBACK: rc = mqtt_publishMessage_qos1_PUBACK(pbuf, len); break; //设备向平台发布 QOS1 确认报文
  136. case PUBREC: rc = mqtt_publishMessage_qos2_PUBREC(pbuf, len); break; //设备向平台发布 QOS2 确认报文
  137. case PUBREL: rc = mqtt_recvPublishMessage_qos2_PUBREL(sock, pbuf, len); break; //平台向设备发布 QOS2 消息释放报文
  138. case PUBCOMP: rc = mqtt_publishMessage_qos2_PUBCOMP(pbuf, len); break; //设备向平台发布 QOS2 消息释放报文的确认报文
  139. case SUBACK: rc = mqtt_subscribeTopic_SUBACK(pbuf, len);break; //设备向平台订阅报文时的响应报文
  140. case UNSUBACK: rc = mqtt_unSubscribeTopic_UNSUBACK(pbuf, len); break; //设备向平台发取消订阅报文时的响应报文
  141. case PINGRESP: rc = mqtt_pingResponse(); break; //心跳响应报文
  142. default: rc = 1; break;
  143. }
  144. return rc;
  145. }
  146. /************************************************************
  147. * @brief 处理发送邮箱 mqtt_recvMbox 中的消息,根据消息的类型,发送对应的数据包
  148. * @param sock: sock编号
  149. boxMsg: 消息内容
  150. * @retval 1: 消息正常处理
  151. * -1: 网络错误
  152. * -2: 组建发送数据时发送错误
  153. *************************************************************/
  154. char pubJsonString[jsonMaxSize];
  155. int mqtt_userSendMessage(int sock, int boxMsg)
  156. {
  157. GATEWAY_PARAMS* get;
  158. get = get_gateway_config_params();
  159. char* TOPIC = (char*)get->messageTopic;
  160. int rc = 1;
  161. //用户发送的数据
  162. if((boxMsg & 0xf0000000) == 0x20000000)
  163. {
  164. switch(boxMsg)
  165. {
  166. case MBOX_USER_PUBLISHQOS0: rc = mqtt_publishMessage_qos0(sock, TOPIC, (uint8_t *)pubJsonString, strlen(pubJsonString)); break;
  167. case MBOX_USER_PUBLISHQOS1: rc = mqtt_publishMessage_qos1(sock, TOPIC, (uint8_t *)pubJsonString, strlen(pubJsonString)); break;
  168. case MBOX_USER_PUBLISHQOS2: rc = mqtt_publishMessage_qos2(sock, TOPIC, (uint8_t *)pubJsonString, strlen(pubJsonString)); break;
  169. }
  170. }
  171. //协议站使用的数据
  172. else if((boxMsg & 0xf0000000) == 0x10000000)
  173. {
  174. switch(boxMsg)
  175. {
  176. case MBOX_MQTT_QOS1PUBACK: rc = mqtt_recvPublishMessage_qos1_PUBACK(sock, mqtt_recvPublishQos1_packid); break;
  177. case MBOX_MQTT_QOS2PUBREC: rc = mqtt_recvPublishMessage_qos2_PUBREC(sock, mqtt_recvPublishQos2_packid); break;
  178. case MBOX_MQTT_QOS2PUBCOMP: rc = mqtt_recvPublishMessage_qos2_PUBCOMP(sock, mqtt_recvPublishQos2_packid); break;
  179. }
  180. }
  181. return rc;
  182. }
  183. OS_EVENT *mqtt_sendMseeageMbox; //发送消息邮箱
  184. int mqtt_connectFlag; //成功连接服务器标志
  185. static int mysock; //连接mqtt服务器的sock编号
  186. /************************************************************
  187. * @brief MQTT主线程
  188. * @param arg: 未使用
  189. * @retval
  190. *************************************************************/
  191. //extern uint16_t ModbusValueData_16;
  192. uint16_t ModbusValueData_16;
  193. void mqtt_userManThread(void *arg)
  194. {
  195. int rc;
  196. uint8_t err;
  197. void *mboxMsg;
  198. MQTT_PRINTF("mqtt mainthread start \r\n");
  199. __MQTT_START:
  200. //1.建立与服务器的连接
  201. mysock = -1;
  202. mqtt_connectFlag = 0;
  203. while(mysock < 0)
  204. {
  205. mysock = mqtt_userConnect();
  206. OSTimeDly(2000);
  207. }
  208. OSMboxAccept(mqtt_sendMseeageMbox); //清空mbox的数据
  209. mqtt_connectFlag = 1;
  210. //2.订阅服务器的主题
  211. rc = mqtt_userSubscribeTopic(mysock);
  212. if(rc <= 0)
  213. {
  214. MQTT_PRINTF("subscribe error \r\n");
  215. if(rc == -1) goto __MQTT_START; //如果网络发生错误,重新建立连接
  216. }
  217. else MQTT_PRINTF("subscribe success \r\n");
  218. //3.循环发送数据
  219. while(1)
  220. {
  221. mboxMsg = OSMboxPend(mqtt_sendMseeageMbox, 60000, &err);
  222. if(OS_ERR_NONE == err)
  223. {
  224. //接收到了 网络异常消息
  225. if((*(unsigned int *)mboxMsg) == MBOX_NETWORK_ERROR) goto __MQTT_START;
  226. else
  227. {
  228. if(mqtt_userSendMessage(mysock, *(unsigned int *)mboxMsg) == -1)
  229. goto __MQTT_START;
  230. }
  231. }
  232. else //超时没有发送数据包,发送心跳包
  233. {
  234. rc = mqtt_pingReq(mysock);
  235. if(rc == -1) goto __MQTT_START;
  236. }
  237. OSTimeDly(1);
  238. }
  239. }
  240. /************************************************************
  241. * @brief MQTT接收线程,处理所有平台下发的数据帧, CONNACK除外
  242. * @param arg: 未使用
  243. * @retval
  244. *************************************************************/
  245. void mqtt_userReceiveThread(void *arg)
  246. {
  247. int len;
  248. int packetType;
  249. int msg;
  250. char* buf = malloc(512);
  251. MQTT_PRINTF("mqtt receivethread start \r\n");
  252. while(1)
  253. {
  254. if(mqtt_connectFlag == 1)
  255. {
  256. len = transport_receive(mysock); //阻塞接收数据
  257. if(len <=0)
  258. {
  259. if(len == EWOULDBLOCK) //接收数据超时,重新接收
  260. {
  261. MQTT_PRINTF("receive data timeout \r\n");
  262. continue;
  263. }
  264. else //接收数据时,网络发生了异常,给主线程发送消息,重新建立连接
  265. {
  266. MQTT_PRINTF("sock close \r\n");
  267. transport_close(mysock);
  268. mqtt_connectFlag = 0;
  269. msg = MBOX_NETWORK_ERROR;
  270. OSMboxPost(mqtt_sendMseeageMbox, &msg);
  271. }
  272. }
  273. memset(mqtt_recvbuffer, 0, MQTT_RECVBUF_LENTH);
  274. packetType = MQTTPacket_read(mqtt_recvbuffer, len, transport_getdata);
  275. mqtt_userReceiveMessage(mysock, packetType, mqtt_recvbuffer, len);
  276. buf = (char*)&mqtt_recvbuffer;
  277. WRITE_MODBUS_DATA(buf);
  278. }
  279. OSTimeDly(1);
  280. }
  281. free(buf);
  282. }
  283. #define APP_TASK_MQTTMAIN_PRIO 6
  284. #define APP_TASK_MQTTMAIN_STK_SIZE 1024
  285. static OS_STK mqttmainTaskStack[APP_TASK_MQTTMAIN_STK_SIZE];
  286. #define APP_TASK_MQTTRECEIVE_PRIO 7
  287. #define APP_TASK_MQTTRECEIVE_STK_SIZE 1024
  288. static OS_STK mqttreceiveTaskStack[APP_TASK_MQTTRECEIVE_STK_SIZE];
  289. /************************************************************
  290. * @brief 创建MQTT发送和接收线程,初始化相关数据
  291. * @param 此函数必须在LWIP协议栈初始完成以后再调用
  292. * @retval
  293. *************************************************************/
  294. void mqtt_threadCreate(void)
  295. {
  296. mqtt_connectFlag = 0;
  297. mqtt_sendMseeageMbox = OSMboxCreate(NULL);
  298. JsonQ = OSQCreate(json_message[0], QUEUE_SIZE); //创建json队列
  299. OSTaskCreate(mqtt_userManThread, NULL, &mqttmainTaskStack[APP_TASK_MQTTMAIN_STK_SIZE-1], APP_TASK_MQTTMAIN_PRIO);
  300. OSTaskCreate(mqtt_userReceiveThread, NULL, &mqttreceiveTaskStack[APP_TASK_MQTTRECEIVE_STK_SIZE-1], APP_TASK_MQTTRECEIVE_PRIO);
  301. }