protocol.c 7.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423
  1. #include "protocol.h"
  2. #include "process.h"
  3. #include "cfg.h"
  4. #include "uart.h"
  5. #include "Motor.h"
  6. #include "AngleSensor.h"
  7. #include "Rtcx.h"
  8. #include "storage.h"
  9. static DataItem tmp_record;
  10. static uint8_t tmp_i=0;
  11. #ifdef IS_BOOTLOADER
  12. uint32_t Firmware_Version[4] = {1, 0, 2, 20240927};
  13. #else
  14. uint32_t Firmware_Version[4] = {1, 1, 8, 20240929};
  15. #endif
  16. uint16_t Read_FirmwareVersion(uint8_t *pBuf, uint16_t buf_len)
  17. {
  18. int i;
  19. if( buf_len < 16){
  20. return 0;
  21. }
  22. for (i = 0; i < 4; ++i)
  23. {
  24. pBuf[i * 4] = (Firmware_Version[i] >> 24) & 0xff;
  25. pBuf[i * 4 + 1] = (Firmware_Version[i] >> 16) & 0xff;
  26. pBuf[i * 4 + 2] = (Firmware_Version[i] >> 8) & 0xff;
  27. pBuf[i * 4 + 3] = (Firmware_Version[i] >> 0) & 0xff;
  28. }
  29. return 16;
  30. }
  31. uint16_t Read_HardwareVersion(uint8_t *pBuf, uint16_t buf_len)
  32. {
  33. if( buf_len < 2){
  34. return 0;
  35. }
  36. pBuf[0] = (config->hw_version >> 8)&0xff;
  37. pBuf[1] = (config->hw_version >> 0)&0xff;
  38. return 2;
  39. }
  40. uint16_t Read_Deviceid(uint8_t *pBuf, uint16_t buf_len)
  41. {
  42. if( buf_len < 4){
  43. return 0;
  44. }
  45. pBuf[0] = (config->deviceid >> 24)&0xff;
  46. pBuf[1] = (config->deviceid >> 16)&0xff;
  47. pBuf[2] = (config->deviceid >> 8)&0xff;
  48. pBuf[3] = (config->deviceid >> 0)&0xff;
  49. return 4;
  50. }
  51. uint16_t Read_Devicetype(uint8_t *pBuf, uint16_t buf_len)
  52. {
  53. if( buf_len < 2){
  54. return 0;
  55. }
  56. pBuf[0] = (config->devicetype >> 8)&0xff;
  57. pBuf[1] = (config->devicetype >> 0)&0xff;
  58. return 2;
  59. }
  60. uint16_t Read_Addr(uint8_t *pBuf, uint16_t buf_len)
  61. {
  62. if( buf_len < 2){
  63. return 0;
  64. }
  65. pBuf[0] = 0x00;
  66. pBuf[1] = config->addr;
  67. return 2;
  68. }
  69. uint16_t Read_Baudrate(uint8_t *pBuf, uint16_t buf_len)
  70. {
  71. if( buf_len < 2){
  72. return 0;
  73. }
  74. pBuf[0] = 0x00;
  75. pBuf[1] = config->br_index;
  76. return 2;
  77. }
  78. //读取锁状态
  79. uint16_t Read_LockStatus(uint8_t *pBuf, uint16_t buf_len)
  80. {
  81. uint8_t tmp = 0;
  82. if( buf_len < 2){
  83. return 0;
  84. }
  85. tmp = Process_GetCoverStatus(); //上盖状态
  86. pBuf[0] = (tmp<<4)|Process_GetLockStatus(); //锁状态
  87. pBuf[1] = 0x00; //油品标识
  88. return 2;
  89. }
  90. //读取开锁、上锁阀值、取样阀值
  91. uint16_t Read_Threshold(uint8_t *pBuf, uint16_t buf_len)
  92. {
  93. if( buf_len < 16){
  94. return 0;
  95. }
  96. pBuf[0] = ((uint8_t*)(&config->unlock_threshold))[0];
  97. pBuf[1] = ((uint8_t*)(&config->unlock_threshold))[1];
  98. pBuf[2] = ((uint8_t*)(&config->unlock_threshold))[2];
  99. pBuf[3] = ((uint8_t*)(&config->unlock_threshold))[3];
  100. pBuf[4] = ((uint8_t*)(&config->lock_threshold))[0];
  101. pBuf[5] = ((uint8_t*)(&config->lock_threshold))[1];
  102. pBuf[6] = ((uint8_t*)(&config->lock_threshold))[2];
  103. pBuf[7] = ((uint8_t*)(&config->lock_threshold))[3];
  104. pBuf[8] = ((uint8_t*)(&config->sample_threshold1))[0];
  105. pBuf[9] = ((uint8_t*)(&config->sample_threshold1))[1];
  106. pBuf[10] = ((uint8_t*)(&config->sample_threshold1))[2];
  107. pBuf[11] = ((uint8_t*)(&config->sample_threshold1))[3];
  108. pBuf[12] = ((uint8_t*)(&config->sample_threshold2))[0];
  109. pBuf[13] = ((uint8_t*)(&config->sample_threshold2))[1];
  110. pBuf[14] = ((uint8_t*)(&config->sample_threshold2))[2];
  111. pBuf[15] = ((uint8_t*)(&config->sample_threshold2))[3];
  112. return 16;
  113. }
  114. //读取编码器角度值
  115. uint16_t Read_Angle(uint8_t *pBuf, uint16_t buf_len)
  116. {
  117. if( buf_len < 4){
  118. return 0;
  119. }
  120. float angle = Process_GetAngle();
  121. pBuf[0] = ((uint8_t*)(&angle))[0];
  122. pBuf[1] = ((uint8_t*)(&angle))[1];
  123. pBuf[2] = ((uint8_t*)(&angle))[2];
  124. pBuf[3] = ((uint8_t*)(&angle))[3];
  125. return 4;
  126. }
  127. //读取设备日期时间
  128. uint16_t Read_DateTime(uint8_t *pBuf, uint16_t buf_len)
  129. {
  130. if( buf_len < 8){
  131. return 0;
  132. }
  133. RTCx_UpdateTime();
  134. pBuf[0] = g_dateTime.year-2000;
  135. pBuf[1] = g_dateTime.month;
  136. pBuf[2] = g_dateTime.day;
  137. pBuf[3] = g_dateTime.hour;
  138. pBuf[4] = g_dateTime.minute;
  139. pBuf[5] = g_dateTime.second;
  140. pBuf[6] = g_dateTime.week;
  141. pBuf[7] = 0x00;
  142. return 8;
  143. }
  144. //读取设备历史记录条数
  145. uint16_t Read_RecordsNum(uint8_t *pBuf, uint16_t buf_len)
  146. {
  147. if( buf_len < 2){
  148. return 0;
  149. }
  150. uint16_t num = Storage_GetItemNum();
  151. pBuf[0] = (num>>8)&0xFF;
  152. pBuf[1] = num&0xFF;
  153. return 2;
  154. }
  155. //读取历史记录
  156. uint16_t Read_Records(uint8_t num, uint8_t *pBuf, uint16_t buf_len)
  157. {
  158. if((num > MAX_RECORDS_PERTIME) ||(buf_len < SIZE_RECORD*num)){
  159. return 0;
  160. }
  161. if(num > Storage_GetItemNum()){
  162. //return 0;
  163. num = Storage_GetItemNum();
  164. }
  165. for(tmp_i=0; tmp_i < num; tmp_i++){
  166. if(0 == Storage_GetItemFromOldest2(tmp_i, &tmp_record))
  167. {
  168. pBuf[tmp_i*SIZE_RECORD+0] = tmp_record.itemtype;
  169. pBuf[tmp_i*SIZE_RECORD+1] = tmp_record.eventtype;
  170. pBuf[tmp_i*SIZE_RECORD+2] = tmp_record.timestamp[0];
  171. pBuf[tmp_i*SIZE_RECORD+3] = tmp_record.timestamp[1];
  172. pBuf[tmp_i*SIZE_RECORD+4] = tmp_record.timestamp[2];
  173. pBuf[tmp_i*SIZE_RECORD+5] = tmp_record.timestamp[3];
  174. pBuf[tmp_i*SIZE_RECORD+6] = tmp_record.timestamp[4];
  175. pBuf[tmp_i*SIZE_RECORD+7] = tmp_record.timestamp[5];
  176. }else{
  177. break;
  178. }
  179. }
  180. Storage_WaitDelete(tmp_i);
  181. return tmp_i*SIZE_RECORD;
  182. }
  183. /*=======================================================================================*/
  184. uint8_t Write_Addr(uint8_t *pdata, uint8_t len)
  185. {
  186. if(len == 2){
  187. config->addr = pdata[1];
  188. return RET_OK|RET_NEED_SAVE;
  189. }else{
  190. return RET_DATAINVALID;
  191. }
  192. }
  193. uint8_t Write_Baudrate(uint8_t *pdata, uint8_t len)
  194. {
  195. if(len == 2){
  196. if(pdata[1] >= BaudRate_4800 && pdata[1] <= BaudRate_230400){
  197. config->br_index = pdata[1];
  198. return RET_OK|RET_NEED_SAVE;
  199. }else{
  200. return RET_DATAINVALID;
  201. }
  202. }else{
  203. return RET_DATAINVALID;
  204. }
  205. }
  206. uint8_t Write_HardwareVersion(uint8_t *pdata, uint8_t len)
  207. {
  208. if(len == 2){
  209. config->hw_version = ((uint16_t)pdata[0]<<8) | pdata[1];
  210. return RET_OK|RET_NEED_SAVE;
  211. }else{
  212. return RET_DATAINVALID;
  213. }
  214. }
  215. uint8_t Write_Deviceid(uint8_t *pdata, uint8_t len)
  216. {
  217. if(len == 4){
  218. config->deviceid = ((uint32_t)pdata[0]<<24) | ((uint32_t)pdata[1]<<16)| ((uint32_t)pdata[2]<<8)| pdata[3];
  219. return RET_OK|RET_NEED_SAVE;
  220. }else{
  221. return RET_DATAINVALID;
  222. }
  223. }
  224. uint8_t Write_Devicetype(uint8_t *pdata, uint8_t len)
  225. {
  226. if(len == 2){
  227. config->devicetype = ((uint16_t)pdata[0]<<8) | pdata[1];
  228. return RET_OK|RET_NEED_SAVE;
  229. }else{
  230. return RET_DATAINVALID;
  231. }
  232. }
  233. //开锁、上锁操作
  234. uint8_t Write_LockOp(uint8_t *pdata, uint8_t len)
  235. {
  236. if(len == 2){
  237. if(0x01 == pdata[0]){ //开锁
  238. Process_OpUnlock(pdata[1]);
  239. }else if(0x02 == pdata[0]){ //上锁
  240. Process_OpLock(pdata[1]);
  241. }else if(0x03 == pdata[0]){ //取样
  242. Process_OpSample(pdata[1]);
  243. }else if(0x04 == pdata[0]){ //正转测试
  244. Motor_Positive(pdata[1]);
  245. }else if(0x05 == pdata[0]){ //反转测试
  246. Motor_Negative(pdata[1]);
  247. }
  248. return RET_OK;
  249. }else{
  250. return RET_DATAINVALID;
  251. }
  252. }
  253. //开锁阀值、上锁阀值、取样阀值 标定
  254. uint8_t Write_ThresholdCalibration(uint8_t *pdata, uint8_t len)
  255. {
  256. if(len == 2){
  257. if(pdata[1] <= 0x03){
  258. Process_CalibrationThreshold(pdata[1]);
  259. return RET_OK|RET_NEED_SAVE;
  260. }
  261. }
  262. return RET_DATAINVALID;
  263. }
  264. //标定设备日期时间
  265. uint8_t Write_DateTime(uint8_t *pdata, uint8_t len)
  266. {
  267. static DateTime dateTime;
  268. if(len == 8){
  269. dateTime.year = pdata[0];
  270. dateTime.year += 2000;
  271. dateTime.month = pdata[1];
  272. dateTime.day = pdata[2];
  273. dateTime.hour = pdata[3];
  274. dateTime.minute = pdata[4];
  275. dateTime.second = pdata[5];
  276. dateTime.week = pdata[6];
  277. RTCx_SetTime(&dateTime);
  278. return RET_OK;
  279. }else{
  280. return RET_DATAINVALID;
  281. }
  282. }
  283. //删除已读取设备历史记录
  284. uint8_t Write_RecordsDelete(uint8_t *pdata, uint8_t len)
  285. {
  286. if(len == 2){
  287. Storage_DeleteConfirm();
  288. return RET_OK;
  289. }else{
  290. return RET_DATAINVALID;
  291. }
  292. }
  293. //编码器校准
  294. uint8_t Write_AngleCalibration(uint8_t *pdata, uint8_t len)
  295. {
  296. if(len == 2){
  297. Process_AngleCalibration();
  298. return RET_OK|RET_NEED_SAVE;
  299. }
  300. return RET_DATAINVALID;
  301. }