modbus_params.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454
  1. #include "at32f403a_407.h"
  2. #include "modbus_params.h"
  3. #include "settings_api.h"
  4. #include "io.h"
  5. #include "uptime.h"
  6. #include "rtc.h"
  7. #include "input.h"
  8. #include "output.h"
  9. #include "log.h"
  10. #include <string.h>
  11. mb_param_t mb_param[MB_PARAM_MAX];
  12. uint32_t rtc_sinhro;
  13. // Пароль для установки системных настроек
  14. uint16_t psw;
  15. bool psw_ok = false;
  16. // Копия системных настроек
  17. sys_settings_t temp_sys_settings;
  18. void get_time(uint8_t* buf, uint8_t size);
  19. void get_din_mode(uint8_t* buf, uint8_t size);
  20. void get_log_entries_number(uint8_t* buf, uint8_t size);
  21. void get_archive_entries_number(uint8_t* buf, uint8_t size);
  22. //
  23. void mb_init_params(void)
  24. {
  25. uint16_t index = 0;
  26. uint16_t addr = 0;
  27. mb_param[index].reg = 0x0100;
  28. mb_param[index].size = 1;
  29. mb_param[index].param = (uint8_t*)&input_state_bit; // Текущее состояние входа
  30. mb_param[index].set = NULL;
  31. mb_param[index].get = NULL;
  32. mb_param[index].check_handler = mb_check_dummy;
  33. index++;
  34. // Счетчики импульсов. Регистры 0x0102 - 0x0111
  35. addr = 0x0102;
  36. for (int i = 0; i < DI_NUMBER; i++)
  37. {
  38. mb_param[index].reg = addr;
  39. mb_param[index].size = 2;
  40. mb_param[index].param = (uint8_t*)&input_cnt[i]; // Счетчик ипульсов
  41. mb_param[index].set = NULL;
  42. mb_param[index].get = NULL;
  43. mb_param[index].check_handler = mb_check_dummy;
  44. addr += 2;
  45. index++;
  46. }
  47. // Режим работы входов
  48. mb_param[index].reg = 0x0120;
  49. mb_param[index].size = 1;
  50. mb_param[index].param = (uint8_t*)&settings.di_mode_bits;
  51. mb_param[index].set = mb_set_din_mode;
  52. mb_param[index].get = NULL;
  53. mb_param[index].check_handler = mb_check_dummy;
  54. index++;
  55. // Нормальное состояние входов
  56. mb_param[index].reg = 0x0122;
  57. mb_param[index].size = 1;
  58. mb_param[index].param = (uint8_t*)&settings.di_norm_state_bits;
  59. mb_param[index].set = NULL;
  60. mb_param[index].get = NULL;
  61. mb_param[index].check_handler = mb_check_dummy;
  62. index++;
  63. // Счетчики импульсов. Регистры 0x0102 - 0x0111
  64. addr = 0x0124;
  65. for (int i = 0; i < DI_NUMBER; i++)
  66. {
  67. mb_param[index].reg = addr;
  68. mb_param[index].size = 1;
  69. mb_param[index].param = (uint8_t*)&settings.di_debounce[i]; // Счетчик ипульсов
  70. mb_param[index].set = NULL;
  71. mb_param[index].get = NULL;
  72. mb_param[index].check_handler = mb_check_dummy;
  73. addr++;
  74. index++;
  75. }
  76. // Текущее состояние выходов
  77. mb_param[index].reg = 0x0200;
  78. mb_param[index].size = 1;
  79. mb_param[index].param = (uint8_t*)&output_state_bit;
  80. mb_param[index].set = mb_set_do;
  81. mb_param[index].get = NULL;
  82. mb_param[index].check_handler = mb_check_dummy;
  83. index++;
  84. // Режим работы выходов
  85. mb_param[index].reg = 0x0202;
  86. mb_param[index].size = 1;
  87. mb_param[index].param = (uint8_t*)&output_mode_bit;
  88. mb_param[index].set = mb_set_do_mode;
  89. mb_param[index].get = NULL;
  90. mb_param[index].check_handler = mb_check_dummy;
  91. index++;
  92. // Состояние выходов в безопасном режиме
  93. mb_param[index].reg = 0x0203;
  94. mb_param[index].size = 1;
  95. mb_param[index].param = (uint8_t*)&settings.do_save_bits;
  96. mb_param[index].set = mb_set_do;
  97. mb_param[index].get = NULL;
  98. mb_param[index].check_handler = mb_check_dummy;
  99. index++;
  100. // Заполнение PWM. Регистры 0x0210 - 0x0217
  101. addr = 0x0210;
  102. for (int i = 0; i < DO_NUMBER; i++)
  103. {
  104. mb_param[index].reg = addr;
  105. mb_param[index].size = 1;
  106. mb_param[index].param = (uint8_t*)&output_pwm[i]; // Счетчик ипульсов
  107. mb_param[index].set = mb_set_do;
  108. mb_param[index].get = NULL;
  109. mb_param[index].check_handler = mb_check_dummy;
  110. addr++;
  111. index++;
  112. }
  113. // Заполнение PWM в безопасном режиме. Регистры 0x0220 - 0x0227
  114. addr = 0x0220;
  115. for (int i = 0; i < DO_NUMBER; i++)
  116. {
  117. mb_param[index].reg = addr;
  118. mb_param[index].size = 1;
  119. mb_param[index].param = (uint8_t*)&output_pwm_save[i]; // Счетчик ипульсов
  120. mb_param[index].set = mb_set_do;
  121. mb_param[index].get = NULL;
  122. mb_param[index].check_handler = mb_check_dummy;
  123. addr++;
  124. index++;
  125. }
  126. // Период PWM. Регистры 0x0220 - 0x0227
  127. addr = 0x0230;
  128. for (int i = 0; i < DO_NUMBER; i++)
  129. {
  130. mb_param[index].reg = addr;
  131. mb_param[index].size = 1;
  132. mb_param[index].param = (uint8_t*)&output_pwm_period[i]; // Счетчик ипульсов
  133. mb_param[index].set = mb_set_do;
  134. mb_param[index].get = NULL;
  135. mb_param[index].check_handler = mb_check_dummy;
  136. addr++;
  137. index++;
  138. }
  139. // Период PWM. Регистры 0x0220 - 0x0227
  140. addr = 0x0240;
  141. for (int i = 0; i < DO_NUMBER; i++)
  142. {
  143. mb_param[index].reg = addr;
  144. mb_param[index].size = 1;
  145. mb_param[index].param = (uint8_t*)&output_pwm_period_save[i]; // Счетчик ипульсов
  146. mb_param[index].set = mb_set_do;
  147. mb_param[index].get = NULL;
  148. mb_param[index].check_handler = mb_check_dummy;
  149. addr++;
  150. index++;
  151. }
  152. // Журналы/рахивы
  153. // Емкость журнала (максимальная)
  154. mb_param[index].reg = 0x0900;
  155. mb_param[index].size = 1;
  156. mb_param[index].param = (uint8_t*)&log_entries_capacity; //
  157. mb_param[index].set = NULL;
  158. mb_param[index].get = NULL;
  159. mb_param[index].check_handler = mb_check_dummy;
  160. index++;
  161. // Текущее количество записей в журнале
  162. mb_param[index].reg = 0x0901;
  163. mb_param[index].size = 1;
  164. mb_param[index].param = NULL; //
  165. mb_param[index].set = NULL;
  166. mb_param[index].get = get_log_entries_number;
  167. mb_param[index].check_handler = mb_check_dummy;
  168. index++;
  169. // Емкость архива (максимальная)
  170. mb_param[index].reg = 0x0902;
  171. mb_param[index].size = 1;
  172. mb_param[index].param = (uint8_t*)&archive_entries_capacity; //
  173. mb_param[index].set = NULL;
  174. mb_param[index].get = NULL;
  175. mb_param[index].check_handler = mb_check_dummy;
  176. index++;
  177. // Текущее количество записей в архиве
  178. mb_param[index].reg = 0x0903;
  179. mb_param[index].size = 1;
  180. mb_param[index].param = NULL; //
  181. mb_param[index].set = NULL;
  182. mb_param[index].get = get_archive_entries_number;
  183. mb_param[index].check_handler = mb_check_dummy;
  184. index++;
  185. // ---------------------------------------------------------------------- //
  186. // Системные настройки
  187. // ---------------------------------------------------------------------- //
  188. // Модель
  189. mb_param[index].reg = 0x0080;
  190. mb_param[index].size = 1;
  191. mb_param[index].param = (uint8_t*)&model_code; //
  192. mb_param[index].set = NULL;
  193. mb_param[index].get = NULL;
  194. mb_param[index].check_handler = mb_check_dummy;
  195. index++;
  196. /*
  197. // Дата производства
  198. mb_param[index].reg = 0x0081;
  199. mb_param[index].size = 2;
  200. mb_param[index].param = (uint8_t*)&temp_sys_settings.prod_date; //
  201. mb_param[index].set = NULL;
  202. mb_param[index].get = NULL;
  203. mb_param[index].check_handler = mb_check_dummy;
  204. index++;
  205. // Серийный номер
  206. mb_param[index].reg = 0x0083;
  207. mb_param[index].size = 2;
  208. mb_param[index].param = (uint8_t*)&temp_sys_settings.sn; //
  209. mb_param[index].set = NULL;
  210. mb_param[index].get = NULL;
  211. mb_param[index].check_handler = mb_check_dummy;
  212. index++;
  213. // Пароль
  214. mb_param[index].reg = 0x008A;
  215. mb_param[index].size = 1;
  216. mb_param[index].param = (uint8_t*)&psw; //
  217. mb_param[index].set = mb_password;
  218. mb_param[index].get = NULL;
  219. mb_param[index].check_handler = mb_check_dummy;
  220. index++;
  221. */
  222. }
  223. // Возвращает размер параметра в регистрах
  224. bool mb_find_param(uint16_t reg, uint16_t *index, uint16_t *size)
  225. {
  226. for (uint16_t i = 0; i < MB_PARAM_MAX; i++)
  227. {
  228. if (mb_param[i].reg == reg)
  229. {
  230. *index = i;
  231. *size = mb_param[i].size;
  232. return true;
  233. }
  234. }
  235. return false;
  236. }
  237. //
  238. mb_delay_action_t mb_set_param(uint8_t *buf, uint16_t index)
  239. {
  240. uint8_t *ptr = mb_param[index].param;
  241. // Если параметр только для чтения
  242. if (mb_param[index].check_handler == NULL)
  243. return MB_NO_ACTION;
  244. for (uint16_t i = 0; i < 2*mb_param[index].size; i++)
  245. {
  246. *ptr = buf[2*mb_param[index].size - 1 - i];
  247. ptr++;
  248. }
  249. /*
  250. if (mb_param[index].check_handler != NULL)
  251. mb_param[index].check_handler();
  252. */
  253. mb_param[index].check_handler();
  254. if (mb_param[index].set != NULL)
  255. return mb_param[index].set();
  256. else
  257. return MB_NO_ACTION;
  258. /*
  259. if (mb_param[index].f_activity)
  260. return mb_param[index].set_handler();
  261. else
  262. return MB_NO_ACTION;
  263. */
  264. }
  265. //
  266. void mb_get_param(uint8_t *buf, uint16_t index)
  267. {
  268. uint8_t *ptr;
  269. if (mb_param[index].get != NULL) {
  270. mb_param[index].get(buf, mb_param[index].size);
  271. return;
  272. }
  273. ptr = mb_param[index].param + 2*mb_param[index].size - 1;
  274. for (uint16_t i = 0; i < 2*mb_param[index].size; i++)
  275. {
  276. *buf = *ptr;
  277. buf++;
  278. ptr--;
  279. }
  280. }
  281. // -------------------------------------------------------------------------- //
  282. // Чтение параметров
  283. // -------------------------------------------------------------------------- //
  284. void get_time(uint8_t* buf, uint8_t size)
  285. {
  286. uint32_t rtc_unix = RTC_GetUnixTime();
  287. uint8_t *ptr = (uint8_t*)&rtc_unix + 2*size - 1;
  288. for (uint16_t i = 0; i < 2*size; i++)
  289. {
  290. *buf = *ptr;
  291. buf++;
  292. ptr--;
  293. }
  294. }
  295. //
  296. void get_din_mode(uint8_t* buf, uint8_t size)
  297. {
  298. }
  299. //
  300. void get_log_entries_number(uint8_t* buf, uint8_t size)
  301. {
  302. uint16_t capacity = log_capacity();
  303. SWAP_16(buf, capacity);
  304. }
  305. //
  306. void get_archive_entries_number(uint8_t* buf, uint8_t size)
  307. {
  308. uint16_t capacity = log_arch_capacity();
  309. SWAP_16(buf, capacity);
  310. }
  311. // -------------------------------------------------------------------------- //
  312. // Установка параметров
  313. // -------------------------------------------------------------------------- //
  314. //
  315. mb_delay_action_t mb_set_din_mode(void)
  316. {
  317. in_set();
  318. return MB_NO_ACTION;
  319. }
  320. //
  321. mb_delay_action_t mb_set_do(void)
  322. {
  323. //do_set();
  324. do_set_common();
  325. return MB_NO_ACTION;
  326. }
  327. //
  328. mb_delay_action_t mb_set_do_mode(void)
  329. {
  330. do_set_mode();
  331. return MB_NO_ACTION;
  332. }
  333. //
  334. mb_delay_action_t mb_set_time(void)
  335. {
  336. TM_RTC_SetDataTimeUnix(rtc_sinhro);
  337. return MB_NO_ACTION;
  338. }
  339. //
  340. mb_delay_action_t mb_password(void)
  341. {
  342. if (psw != MB_PASSWORD)
  343. return MB_PAS_ERR;
  344. else {
  345. if (psw_ok == false) {
  346. psw_ok = true;
  347. return MB_PAS_OK;
  348. }
  349. else
  350. return MB_NO_ACTION;
  351. }
  352. }
  353. // -------------------------------------------------------------------------- //
  354. // Проверка параметров //
  355. // -------------------------------------------------------------------------- //
  356. //
  357. void mb_check_dummy(void)
  358. {
  359. }