shm_comm_packet.c 4.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252
  1. /******************************************************************************
  2. 版权所有: 文件名称: shm_comm_packet.c
  3. 文件名称: shm_comm_packet.c
  4. 文件版本: 01.01
  5. 创建作者: sunxi
  6. 创建日期: 2022-04-25
  7. 功能说明: 共享内存通信打包
  8. 其它说明:
  9. 修改记录:
  10. */
  11. /*------------------------------- 头文件 --------------------------------------
  12. */
  13. #include "head.h"
  14. #include "shm.h"
  15. /*------------------------------- 宏定义 --------------------------------------
  16. */
  17. /*------------------------------ 类型结构 -------------------------------------
  18. */
  19. /*------------------------------ 函数声明 -------------------------------------
  20. */
  21. /*------------------------------ 外部函数 -------------------------------------
  22. 外部函数供其它实体文件引用,必须仔细检查传入参数的合法性.
  23. */
  24. /******************************************************************************
  25. 函数名称: shm_comm_packet_write
  26. 函数版本: 01.01
  27. 创建作者: sunxi
  28. 创建日期: 2022-04-25
  29. 函数说明: 向共享内存写入数据(自动处理A,B,crc).
  30. 参数说明:
  31. addr:共享内存的地址
  32. data:写入数据
  33. len:写入数据长度
  34. 返回值: 成功返回写入数据的长度, 失败返回-1
  35. 修改记录:
  36. 使用说明:
  37. 输入参数data为带有A,B和crc的结构体,len为整个结构体的长度
  38. 应用层不需要理会A,B和crc.
  39. */
  40. int shm_comm_packet_write(uint32_t addr, uint8_t *data, uint32_t len)
  41. {
  42. uint16_t A;
  43. int ret;
  44. uint16_t crc = 0;
  45. if(data == NULL)
  46. return -1;
  47. if(len == 0 )
  48. return -1;
  49. //A++
  50. memcpy(&A,&SHM_BASE_W[addr],2);
  51. A++;
  52. memcpy(&SHM_BASE_W[addr],&A,2);
  53. //写数据区
  54. ret = shm_write(addr+4, data+4, len-6);
  55. if(ret == -1)
  56. return -1;
  57. //crc
  58. crc = CrcStr(data+4, len-6);//CRC
  59. memcpy(&SHM_BASE_W[addr+len-2],&crc,2);
  60. //B++
  61. memcpy(&SHM_BASE_W[addr+2],&A,2); //A和B保证一样
  62. return ret+6;//加上A,B,crc的长度
  63. }
  64. /******************************************************************************
  65. 函数名称: shm_comm_packet_read
  66. 函数版本: 01.01
  67. 创建作者: sunxi
  68. 创建日期: 2022-04-25
  69. 函数说明: 读取共享内存的数据(自动处理A,B,crc).
  70. 参数说明:
  71. addr:所以读取共享内存的地址
  72. len:需要读取数据的长度
  73. out_data:输出buf
  74. out_data_size:输出buf的长度
  75. 返回值:
  76. 成功返回读取数据的长度,
  77. 失败返回 <0
  78. 修改记录:
  79. 使用说明:
  80. 输入参数out_data为带有A,B和crc的结构体,len为整个结构体的长度
  81. 应用层不需要理会A,B和crc.
  82. */
  83. int shm_comm_packet_read(uint32_t addr, uint32_t len, uint8_t *out_data, uint32_t out_data_size)
  84. {
  85. uint16_t A,B;
  86. //uint16_t last_A = 0;
  87. //uint16_t last_B = 0;
  88. int ret;
  89. uint16_t crc = 0;
  90. uint16_t read_crc = 0;
  91. //shm_read(addr, 2, (uint8_t*)&last_A, sizeof(last_A));
  92. //shm_read(addr+2, 2, (uint8_t*)&last_B, sizeof(last_B));
  93. //printf("last_A=%X, last_B=%X\n", last_A,last_B);
  94. //if(last_A == last_B)
  95. {
  96. //idle
  97. ret = shm_read(addr, len, out_data, out_data_size);
  98. A = out_data[0]+((uint16_t)out_data[1]<<8);
  99. B = out_data[2]+((uint16_t)out_data[3]<<8);
  100. //printf("A=%X, B=%X\n", A,B);
  101. if((A == B) )//&& (A == last_A))
  102. {
  103. //在拷贝过程中,数据没有被修改
  104. crc = CrcStr(out_data+4,len-6);
  105. read_crc = out_data[len-2]+((uint16_t)out_data[len-1]<<8);
  106. //printf("cal crc=%04X, read crc=%04X\n", crc,read_crc);
  107. if(crc != read_crc)
  108. {
  109. //crc error
  110. return -3;
  111. }
  112. }
  113. else
  114. {
  115. //busy 裸核正在写数据
  116. return -2;
  117. }
  118. }
  119. //else
  120. //{
  121. //busy 裸核正在写数据
  122. // return -2;
  123. //}
  124. return ret;
  125. }
  126. /******************************************************************************
  127. 函数名称: shm_comm_packet_read_noABcrc
  128. 函数版本: 01.01
  129. 创建作者: sunxi
  130. 创建日期: 2022-04-25
  131. 函数说明: 读取共享内存的数据(结构体不存在A,B,crc).
  132. 参数说明:
  133. addr:所以读取共享内存的地址
  134. len:需要读取数据的长度
  135. out_data:输出buf
  136. out_data_size:输出buf的长度
  137. 返回值:
  138. 成功返回读取数据的长度,
  139. 失败返回 <0
  140. 修改记录:
  141. 使用说明:
  142. 如:Ad7616采样点结构
  143. 本函数只处理不含有A,B和crc的结构体
  144. */
  145. int shm_comm_packet_read_noABcrc(uint32_t addr, uint32_t len, uint8_t *out_data, uint32_t out_data_size)
  146. {
  147. int ret;
  148. ret = shm_read(addr, len, out_data, out_data_size);
  149. return ret;
  150. }
  151. /*------------------------------ 测试函数 -------------------------------------
  152. */
  153. typedef struct testtt_t
  154. {
  155. uint16_t A;
  156. uint16_t B;
  157. uint16_t rc[16];
  158. uint16_t crc;
  159. }testtt_t;
  160. testtt_t aabfd,readaaaa;
  161. void shm_comm_test(void)
  162. {
  163. int i;
  164. int ret = 0;
  165. for(i=0;i<16;i++)
  166. {
  167. aabfd.rc[i]=i+2;
  168. printf("aabfd.rc[%d]=%X\n",i,aabfd.rc[i]);
  169. }
  170. ret = shm_comm_packet_write(0,(uint8_t*)&aabfd,sizeof(aabfd));
  171. printf("shm_comm_packet_write ret=%d\n",ret);
  172. if(ret > 0)
  173. {
  174. for(i=0;i<ret;i++)
  175. {
  176. printf("%X ",SHM_BASE_W[i]);
  177. }
  178. printf("\n ");
  179. }
  180. ret = shm_comm_packet_read(0, sizeof(readaaaa), (uint8_t*)&readaaaa, sizeof(readaaaa));
  181. printf("shm_comm_packet_read ret=%d\n",ret);
  182. if(ret > 0)
  183. {
  184. for(i=0;i<16;i++)
  185. {
  186. printf("%X ",readaaaa.rc[i]);
  187. }
  188. printf("\n ");
  189. }
  190. }
  191. /*------------------------------ 文件结束 -------------------------------------
  192. */