Sensors.c 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661
  1. /*
  2. Unitemp - Universal temperature reader
  3. Copyright (C) 2022-2023 Victor Nikitchuk (https://github.com/quen0n)
  4. This program is free software: you can redistribute it and/or modify
  5. it under the terms of the GNU General Public License as published by
  6. the Free Software Foundation, either version 3 of the License, or
  7. (at your option) any later version.
  8. This program is distributed in the hope that it will be useful,
  9. but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11. GNU General Public License for more details.
  12. You should have received a copy of the GNU General Public License
  13. along with this program. If not, see <https://www.gnu.org/licenses/>.
  14. */
  15. #include "Sensors.h"
  16. #include <furi_hal_power.h>
  17. //Порты ввода/вывода, которые не были обозначены в общем списке
  18. const GpioPin SWC_10 = {.pin = LL_GPIO_PIN_14, .port = GPIOA};
  19. const GpioPin SIO_12 = {.pin = LL_GPIO_PIN_13, .port = GPIOA};
  20. const GpioPin TX_13 = {.pin = LL_GPIO_PIN_6, .port = GPIOB};
  21. const GpioPin RX_14 = {.pin = LL_GPIO_PIN_7, .port = GPIOB};
  22. //Количество доступных портов ввода/вывода
  23. #define GPIO_ITEMS (sizeof(GPIOList) / sizeof(GPIO))
  24. //Количество интерфейсов
  25. #define INTERFACES_TYPES_COUNT (int)(sizeof(interfaces) / sizeof(const Interface*))
  26. //Количество типов датчиков
  27. #define SENSOR_TYPES_COUNT (int)(sizeof(sensorTypes) / sizeof(const SensorType*))
  28. //Перечень достуных портов ввода/вывода
  29. static const GPIO GPIOList[] = {
  30. {2, "2 (A7)", &gpio_ext_pa7},
  31. {3, "3 (A6)", &gpio_ext_pa6},
  32. {4, "4 (A4)", &gpio_ext_pa4},
  33. {5, "5 (B3)", &gpio_ext_pb3},
  34. {6, "6 (B2)", &gpio_ext_pb2},
  35. {7, "7 (C3)", &gpio_ext_pc3},
  36. {10, " 10(SWC) ", &SWC_10},
  37. {12, "12 (SIO)", &SIO_12},
  38. {13, "13 (TX)", &TX_13},
  39. {14, "14 (RX)", &RX_14},
  40. {15, "15 (C1)", &gpio_ext_pc1},
  41. {16, "16 (C0)", &gpio_ext_pc0},
  42. {17, "17 (1W)", &gpio_ibutton}};
  43. //Список интерфейсов, которые прикреплены к GPIO (определяется индексом)
  44. //NULL - порт свободен, указатель на интерфейс - порт занят этим интерфейсом
  45. static const Interface* gpio_interfaces_list[GPIO_ITEMS] = {0};
  46. const Interface SINGLE_WIRE = {
  47. .name = "Single wire",
  48. .allocator = unitemp_singlewire_alloc,
  49. .mem_releaser = unitemp_singlewire_free,
  50. .updater = unitemp_singlewire_update};
  51. const Interface I2C = {
  52. .name = "I2C",
  53. .allocator = unitemp_I2C_sensor_alloc,
  54. .mem_releaser = unitemp_I2C_sensor_free,
  55. .updater = unitemp_I2C_sensor_update};
  56. const Interface ONE_WIRE = {
  57. .name = "One wire",
  58. .allocator = unitemp_onewire_sensor_alloc,
  59. .mem_releaser = unitemp_onewire_sensor_free,
  60. .updater = unitemp_onewire_sensor_update};
  61. const Interface SPI = {
  62. .name = "SPI",
  63. .allocator = unitemp_spi_sensor_alloc,
  64. .mem_releaser = unitemp_spi_sensor_free,
  65. .updater = unitemp_spi_sensor_update};
  66. //Перечень интерфейсов подключения
  67. //static const Interface* interfaces[] = {&SINGLE_WIRE, &I2C, &ONE_WIRE, &SPI};
  68. //Перечень датчиков
  69. static const SensorType* sensorTypes[] = {&DHT11, &DHT12_SW, &DHT20, &DHT21, &DHT22,
  70. &Dallas, &AM2320_SW, &AM2320_I2C, &HTU21x, &AHT10,
  71. &SHT30, &GXHT30, &LM75, &HDC1080, &BMP180,
  72. &BMP280, &BME280, &BME680, &MAX31855, &MAX6675,
  73. &SCD30, &SCD40};
  74. const SensorType* unitemp_sensors_getTypeFromInt(uint8_t index) {
  75. if(index > SENSOR_TYPES_COUNT) return NULL;
  76. return sensorTypes[index];
  77. }
  78. const SensorType* unitemp_sensors_getTypeFromStr(char* str) {
  79. UNUSED(str);
  80. if(str == NULL) return NULL;
  81. for(uint8_t i = 0; i < unitemp_sensors_getTypesCount(); i++) {
  82. if(!strcmp(str, sensorTypes[i]->typename)) {
  83. return sensorTypes[i];
  84. }
  85. }
  86. return NULL;
  87. }
  88. uint8_t unitemp_sensors_getTypesCount(void) {
  89. return SENSOR_TYPES_COUNT;
  90. }
  91. const SensorType** unitemp_sensors_getTypes(void) {
  92. return sensorTypes;
  93. }
  94. int unitemp_getIntFromType(const SensorType* type) {
  95. for(int i = 0; i < SENSOR_TYPES_COUNT; i++) {
  96. if(!strcmp(type->typename, sensorTypes[i]->typename)) {
  97. return i;
  98. }
  99. }
  100. return 255;
  101. }
  102. const GPIO* unitemp_gpio_getFromInt(uint8_t name) {
  103. for(uint8_t i = 0; i < GPIO_ITEMS; i++) {
  104. if(GPIOList[i].num == name) {
  105. return &GPIOList[i];
  106. }
  107. }
  108. return NULL;
  109. }
  110. const GPIO* unitemp_gpio_getFromIndex(uint8_t index) {
  111. return &GPIOList[index];
  112. }
  113. uint8_t unitemp_gpio_toInt(const GPIO* gpio) {
  114. if(gpio == NULL) return 255;
  115. for(uint8_t i = 0; i < GPIO_ITEMS; i++) {
  116. if(GPIOList[i].pin->pin == gpio->pin->pin && GPIOList[i].pin->port == gpio->pin->port) {
  117. return GPIOList[i].num;
  118. }
  119. }
  120. return 255;
  121. }
  122. uint8_t unitemp_gpio_to_index(const GpioPin* gpio) {
  123. if(gpio == NULL) return 255;
  124. for(uint8_t i = 0; i < GPIO_ITEMS; i++) {
  125. if(GPIOList[i].pin->pin == gpio->pin && GPIOList[i].pin->port == gpio->port) {
  126. return i;
  127. }
  128. }
  129. return 255;
  130. }
  131. uint8_t unitemp_gpio_getAviablePortsCount(const Interface* interface, const GPIO* extraport) {
  132. uint8_t aviable_ports_count = 0;
  133. for(uint8_t i = 0; i < GPIO_ITEMS; i++) {
  134. //Проверка для one wire
  135. if(interface == &ONE_WIRE) {
  136. if(((gpio_interfaces_list[i] == NULL || gpio_interfaces_list[i] == &ONE_WIRE)) ||
  137. (unitemp_gpio_getFromIndex(i) == extraport)) {
  138. aviable_ports_count++;
  139. }
  140. }
  141. //Проверка для single wire
  142. if(interface == &SINGLE_WIRE || interface == &SPI) {
  143. if(gpio_interfaces_list[i] == NULL || (unitemp_gpio_getFromIndex(i) == extraport)) {
  144. aviable_ports_count++;
  145. }
  146. }
  147. if(interface == &I2C) {
  148. //У I2C два фиксированых порта
  149. return 0;
  150. }
  151. }
  152. return aviable_ports_count;
  153. }
  154. void unitemp_gpio_lock(const GPIO* gpio, const Interface* interface) {
  155. uint8_t i = unitemp_gpio_to_index(gpio->pin);
  156. if(i == 255) return;
  157. gpio_interfaces_list[i] = interface;
  158. }
  159. void unitemp_gpio_unlock(const GPIO* gpio) {
  160. uint8_t i = unitemp_gpio_to_index(gpio->pin);
  161. if(i == 255) return;
  162. gpio_interfaces_list[i] = NULL;
  163. }
  164. const GPIO*
  165. unitemp_gpio_getAviablePort(const Interface* interface, uint8_t index, const GPIO* extraport) {
  166. //Проверка для I2C
  167. if(interface == &I2C) {
  168. if((gpio_interfaces_list[10] == NULL || gpio_interfaces_list[10] == &I2C) &&
  169. (gpio_interfaces_list[11] == NULL || gpio_interfaces_list[11] == &I2C)) {
  170. //Возврат истины
  171. return unitemp_gpio_getFromIndex(0);
  172. } else {
  173. //Возврат лжи
  174. return NULL;
  175. }
  176. }
  177. if(interface == &SPI) {
  178. if(!((gpio_interfaces_list[0] == NULL || gpio_interfaces_list[0] == &SPI) &&
  179. (gpio_interfaces_list[1] == NULL || gpio_interfaces_list[1] == &SPI) &&
  180. (gpio_interfaces_list[3] == NULL || gpio_interfaces_list[3] == &SPI))) {
  181. return NULL;
  182. }
  183. }
  184. uint8_t aviable_index = 0;
  185. for(uint8_t i = 0; i < GPIO_ITEMS; i++) {
  186. //Проверка для one wire
  187. if(interface == &ONE_WIRE) {
  188. if(((gpio_interfaces_list[i] == NULL || gpio_interfaces_list[i] == &ONE_WIRE)) ||
  189. (unitemp_gpio_getFromIndex(i) == extraport)) {
  190. if(aviable_index == index) {
  191. return unitemp_gpio_getFromIndex(i);
  192. } else {
  193. aviable_index++;
  194. }
  195. }
  196. }
  197. //Проверка для single wire
  198. if(interface == &SINGLE_WIRE || interface == &SPI) {
  199. if(gpio_interfaces_list[i] == NULL || unitemp_gpio_getFromIndex(i) == extraport) {
  200. if(aviable_index == index) {
  201. return unitemp_gpio_getFromIndex(i);
  202. } else {
  203. aviable_index++;
  204. }
  205. }
  206. }
  207. }
  208. return NULL;
  209. }
  210. void unitemp_sensor_delete(Sensor* sensor) {
  211. for(uint8_t i = 0; i < app->sensors_count; i++) {
  212. if(app->sensors[i] == sensor) {
  213. app->sensors[i]->status = UT_SENSORSTATUS_INACTIVE;
  214. unitemp_sensors_save();
  215. unitemp_sensors_reload();
  216. return;
  217. }
  218. }
  219. }
  220. Sensor* unitemp_sensor_getActive(uint8_t index) {
  221. uint8_t aviable_index = 0;
  222. for(uint8_t i = 0; i < app->sensors_count; i++) {
  223. if(app->sensors[i]->status != UT_SENSORSTATUS_INACTIVE) {
  224. if(aviable_index == index) {
  225. return app->sensors[i];
  226. } else {
  227. aviable_index++;
  228. }
  229. }
  230. }
  231. return NULL;
  232. }
  233. uint8_t unitemp_sensors_getCount(void) {
  234. if(app->sensors == NULL) return 0;
  235. return app->sensors_count;
  236. }
  237. uint8_t unitemp_sensors_getActiveCount(void) {
  238. if(app->sensors == NULL) return 0;
  239. uint8_t counter = 0;
  240. for(uint8_t i = 0; i < unitemp_sensors_getCount(); i++) {
  241. if(app->sensors[i]->status != UT_SENSORSTATUS_INACTIVE) counter++;
  242. }
  243. return counter;
  244. }
  245. void unitemp_sensors_add(Sensor* sensor) {
  246. app->sensors =
  247. (Sensor**)realloc(app->sensors, (unitemp_sensors_getCount() + 1) * sizeof(Sensor*));
  248. app->sensors[unitemp_sensors_getCount()] = sensor;
  249. app->sensors_count++;
  250. }
  251. bool unitemp_sensors_load(void) {
  252. UNITEMP_DEBUG("Loading sensors...");
  253. //Выделение памяти на поток
  254. app->file_stream = file_stream_alloc(app->storage);
  255. //Переменная пути к файлу
  256. FuriString* filepath = furi_string_alloc();
  257. //Составление пути к файлу
  258. furi_string_printf(filepath, "%s/%s", APP_PATH_FOLDER, APP_FILENAME_SENSORS);
  259. //Открытие потока к файлу с датчиками
  260. if(!file_stream_open(
  261. app->file_stream, furi_string_get_cstr(filepath), FSAM_READ_WRITE, FSOM_OPEN_EXISTING)) {
  262. // Free file path string if we got an error
  263. furi_string_free(filepath);
  264. if(file_stream_get_error(app->file_stream) == FSE_NOT_EXIST) {
  265. FURI_LOG_W(APP_NAME, "Missing sensors file");
  266. //Закрытие потока и освобождение памяти
  267. file_stream_close(app->file_stream);
  268. stream_free(app->file_stream);
  269. return false;
  270. } else {
  271. FURI_LOG_E(
  272. APP_NAME,
  273. "An error occurred while loading the sensors file: %d",
  274. file_stream_get_error(app->file_stream));
  275. //Закрытие потока и освобождение памяти
  276. file_stream_close(app->file_stream);
  277. stream_free(app->file_stream);
  278. return false;
  279. }
  280. }
  281. // Free file path string if we successfully opened the file
  282. furi_string_free(filepath);
  283. //Вычисление размера файла
  284. uint16_t file_size = stream_size(app->file_stream);
  285. //Если файл пустой, то:
  286. if(file_size == (uint8_t)0) {
  287. FURI_LOG_W(APP_NAME, "Sensors file is empty");
  288. //Закрытие потока и освобождение памяти
  289. file_stream_close(app->file_stream);
  290. stream_free(app->file_stream);
  291. return false;
  292. }
  293. //Выделение памяти под загрузку файла
  294. uint8_t* file_buf = malloc(file_size);
  295. //Опустошение буфера файла
  296. memset(file_buf, 0, file_size);
  297. //Загрузка файла
  298. if(stream_read(app->file_stream, file_buf, file_size) != file_size) {
  299. //Выход при ошибке чтения
  300. FURI_LOG_E(APP_NAME, "Error reading sensors file");
  301. //Закрытие потока и освобождение памяти
  302. file_stream_close(app->file_stream);
  303. stream_free(app->file_stream);
  304. free(file_buf);
  305. return false;
  306. }
  307. //Указатель на начало строки
  308. FuriString* file = furi_string_alloc_set_str((char*)file_buf);
  309. //Сколько байт до конца строки
  310. size_t line_end = 0;
  311. while(line_end != ((size_t)-1) && line_end != (size_t)(file_size - 1)) {
  312. //Имя датчика
  313. char name[11] = {0};
  314. //Тип датчика
  315. char type[11] = {0};
  316. //Смещение по температуре
  317. int temp_offset = 0;
  318. //Смещение по строке для отделения аргументов
  319. int offset = 0;
  320. //Чтение из строки
  321. sscanf(((char*)(file_buf + line_end)), "%s %s %d %n", name, type, &temp_offset, &offset);
  322. //Ограничение длины имени
  323. name[10] = '\0';
  324. //Замена ? на пробел
  325. for(uint8_t i = 0; i < 10; i++) {
  326. if(name[i] == '?') name[i] = ' ';
  327. }
  328. char* args = ((char*)(file_buf + line_end + offset));
  329. const SensorType* stype = unitemp_sensors_getTypeFromStr(type);
  330. //Проверка типа датчика
  331. if(stype != NULL && sizeof(name) > 0 && sizeof(name) <= 11) {
  332. Sensor* sensor =
  333. unitemp_sensor_alloc(name, unitemp_sensors_getTypeFromStr(type), args);
  334. if(sensor != NULL) {
  335. sensor->temp_offset = temp_offset;
  336. unitemp_sensors_add(sensor);
  337. } else {
  338. FURI_LOG_E(APP_NAME, "Failed sensor (%s:%s) mem allocation", name, type);
  339. }
  340. } else {
  341. FURI_LOG_E(APP_NAME, "Unsupported sensor name (%s) or sensor type (%s)", name, type);
  342. }
  343. //Вычисление конца строки
  344. line_end = furi_string_search_char(file, '\n', line_end + 1);
  345. }
  346. free(file_buf);
  347. file_stream_close(app->file_stream);
  348. stream_free(app->file_stream);
  349. FURI_LOG_I(APP_NAME, "Sensors have been successfully loaded");
  350. return true;
  351. }
  352. bool unitemp_sensors_save(void) {
  353. UNITEMP_DEBUG("Saving sensors...");
  354. //Выделение памяти для потока
  355. app->file_stream = file_stream_alloc(app->storage);
  356. //Переменная пути к файлу
  357. FuriString* filepath = furi_string_alloc();
  358. //Составление пути к файлу
  359. furi_string_printf(filepath, "%s/%s", APP_PATH_FOLDER, APP_FILENAME_SENSORS);
  360. //Создание папки плагина
  361. storage_common_mkdir(app->storage, APP_PATH_FOLDER);
  362. //Открытие потока
  363. if(!file_stream_open(
  364. app->file_stream, furi_string_get_cstr(filepath), FSAM_READ_WRITE, FSOM_CREATE_ALWAYS)) {
  365. // Free file path string if we got an error
  366. furi_string_free(filepath);
  367. FURI_LOG_E(
  368. APP_NAME,
  369. "An error occurred while saving the sensors file: %d",
  370. file_stream_get_error(app->file_stream));
  371. //Закрытие потока и освобождение памяти
  372. file_stream_close(app->file_stream);
  373. stream_free(app->file_stream);
  374. return false;
  375. }
  376. // Free file path string if we successfully opened the file
  377. furi_string_free(filepath);
  378. //Сохранение датчиков
  379. for(uint8_t i = 0; i < unitemp_sensors_getActiveCount(); i++) {
  380. Sensor* sensor = unitemp_sensor_getActive(i);
  381. //Замена пробела на ?
  382. for(uint8_t i = 0; i < 10; i++) {
  383. if(sensor->name[i] == ' ') sensor->name[i] = '?';
  384. }
  385. stream_write_format(
  386. app->file_stream,
  387. "%s %s %d ",
  388. sensor->name,
  389. sensor->type->typename,
  390. sensor->temp_offset);
  391. if(sensor->type->interface == &SINGLE_WIRE) {
  392. stream_write_format(
  393. app->file_stream, "%d\n", unitemp_singlewire_sensorGetGPIO(sensor)->num);
  394. }
  395. if(sensor->type->interface == &SPI) {
  396. uint8_t gpio_num = ((SPISensor*)sensor->instance)->CS_pin->num;
  397. stream_write_format(app->file_stream, "%d\n", gpio_num);
  398. }
  399. if(sensor->type->interface == &I2C) {
  400. stream_write_format(
  401. app->file_stream, "%X\n", ((I2CSensor*)sensor->instance)->currentI2CAdr);
  402. }
  403. if(sensor->type->interface == &ONE_WIRE) {
  404. stream_write_format(
  405. app->file_stream,
  406. "%d %02X%02X%02X%02X%02X%02X%02X%02X\n",
  407. ((OneWireSensor*)sensor->instance)->bus->gpio->num,
  408. ((OneWireSensor*)sensor->instance)->deviceID[0],
  409. ((OneWireSensor*)sensor->instance)->deviceID[1],
  410. ((OneWireSensor*)sensor->instance)->deviceID[2],
  411. ((OneWireSensor*)sensor->instance)->deviceID[3],
  412. ((OneWireSensor*)sensor->instance)->deviceID[4],
  413. ((OneWireSensor*)sensor->instance)->deviceID[5],
  414. ((OneWireSensor*)sensor->instance)->deviceID[6],
  415. ((OneWireSensor*)sensor->instance)->deviceID[7]);
  416. }
  417. }
  418. //Закрытие потока и освобождение памяти
  419. file_stream_close(app->file_stream);
  420. stream_free(app->file_stream);
  421. FURI_LOG_I(APP_NAME, "Sensors have been successfully saved");
  422. return true;
  423. }
  424. void unitemp_sensors_reload(void) {
  425. unitemp_sensors_deInit();
  426. unitemp_sensors_free();
  427. unitemp_sensors_load();
  428. unitemp_sensors_init();
  429. }
  430. bool unitemp_sensor_isContains(Sensor* sensor) {
  431. for(uint8_t i = 0; i < unitemp_sensors_getCount(); i++) {
  432. if(app->sensors[i] == sensor) return true;
  433. }
  434. return false;
  435. }
  436. Sensor* unitemp_sensor_alloc(char* name, const SensorType* type, char* args) {
  437. if(name == NULL || type == NULL) return NULL;
  438. bool status = false;
  439. //Выделение памяти под датчик
  440. Sensor* sensor = malloc(sizeof(Sensor));
  441. if(sensor == NULL) {
  442. FURI_LOG_E(APP_NAME, "Sensor %s allocation error", name);
  443. return NULL;
  444. }
  445. //Выделение памяти под имя
  446. sensor->name = malloc(11);
  447. if(sensor->name == NULL) {
  448. FURI_LOG_E(APP_NAME, "Sensor %s name allocation error", name);
  449. return NULL;
  450. }
  451. //Запись имени датчка
  452. strcpy(sensor->name, name);
  453. //Тип датчика
  454. sensor->type = type;
  455. //Статус датчика по умолчанию - ошибка
  456. sensor->status = UT_SENSORSTATUS_ERROR;
  457. //Время последнего опроса
  458. sensor->lastPollingTime =
  459. furi_get_tick() - 10000; //чтобы первый опрос произошёл как можно раньше
  460. sensor->temp = -128.0f;
  461. sensor->hum = -128.0f;
  462. sensor->pressure = -128.0f;
  463. sensor->temp_offset = 0;
  464. //Выделение памяти под инстанс датчика в зависимости от его интерфейса
  465. status = sensor->type->interface->allocator(sensor, args);
  466. //Выход если датчик успешно развёрнут
  467. if(status) {
  468. UNITEMP_DEBUG("Sensor %s allocated", name);
  469. return sensor;
  470. }
  471. //Выход с очисткой если память для датчика не была выделена
  472. free(sensor->name);
  473. free(sensor);
  474. FURI_LOG_E(APP_NAME, "Sensor %s(%s) allocation error", name, type->typename);
  475. return NULL;
  476. }
  477. void unitemp_sensor_free(Sensor* sensor) {
  478. if(sensor == NULL) {
  479. FURI_LOG_E(APP_NAME, "Null pointer sensor releasing");
  480. return;
  481. }
  482. if(sensor->type == NULL) {
  483. FURI_LOG_E(APP_NAME, "Sensor type is null");
  484. return;
  485. }
  486. if(sensor->type->mem_releaser == NULL) {
  487. FURI_LOG_E(APP_NAME, "Sensor releaser is null");
  488. return;
  489. }
  490. bool status = false;
  491. //Высвобождение памяти под инстанс
  492. status = sensor->type->interface->mem_releaser(sensor);
  493. if(status) {
  494. UNITEMP_DEBUG("Sensor %s memory successfully released", sensor->name);
  495. } else {
  496. FURI_LOG_E(APP_NAME, "Sensor %s memory is not released", sensor->name);
  497. }
  498. free(sensor->name);
  499. }
  500. void unitemp_sensors_free(void) {
  501. for(uint8_t i = 0; i < unitemp_sensors_getCount(); i++) {
  502. unitemp_sensor_free(app->sensors[i]);
  503. }
  504. app->sensors_count = 0;
  505. }
  506. bool unitemp_sensors_init(void) {
  507. bool result = true;
  508. //Перебор датчиков из списка
  509. for(uint8_t i = 0; i < unitemp_sensors_getCount(); i++) {
  510. //Включение 5V если на порту 1 FZ его нет
  511. //Может пропасть при отключении USB
  512. if(furi_hal_power_is_otg_enabled() != true) {
  513. furi_hal_power_enable_otg();
  514. UNITEMP_DEBUG("OTG enabled");
  515. }
  516. if(!(*app->sensors[i]->type->initializer)(app->sensors[i])) {
  517. FURI_LOG_E(
  518. APP_NAME,
  519. "An error occurred during sensor initialization %s",
  520. app->sensors[i]->name);
  521. result = false;
  522. }
  523. FURI_LOG_I(APP_NAME, "Sensor %s successfully initialized", app->sensors[i]->name);
  524. }
  525. app->sensors_ready = true;
  526. return result;
  527. }
  528. bool unitemp_sensors_deInit(void) {
  529. bool result = true;
  530. //Выключение 5 В если до этого оно не было включено
  531. if(app->settings.lastOTGState != true) {
  532. furi_hal_power_disable_otg();
  533. UNITEMP_DEBUG("OTG disabled");
  534. }
  535. //Перебор датчиков из списка
  536. for(uint8_t i = 0; i < unitemp_sensors_getCount(); i++) {
  537. if(!(*app->sensors[i]->type->deinitializer)(app->sensors[i])) {
  538. FURI_LOG_E(
  539. APP_NAME,
  540. "An error occurred during sensor deinitialization %s",
  541. app->sensors[i]->name);
  542. result = false;
  543. }
  544. }
  545. return result;
  546. }
  547. UnitempStatus unitemp_sensor_updateData(Sensor* sensor) {
  548. if(sensor == NULL) return UT_SENSORSTATUS_ERROR;
  549. //Проверка на допустимость опроса датчика
  550. if(furi_get_tick() - sensor->lastPollingTime < sensor->type->pollingInterval) {
  551. //Возврат ошибки если последний опрос датчика был неудачным
  552. if(sensor->status == UT_SENSORSTATUS_TIMEOUT) {
  553. return UT_SENSORSTATUS_TIMEOUT;
  554. }
  555. return UT_SENSORSTATUS_EARLYPOOL;
  556. }
  557. sensor->lastPollingTime = furi_get_tick();
  558. if(!furi_hal_power_is_otg_enabled()) {
  559. furi_hal_power_enable_otg();
  560. }
  561. sensor->status = sensor->type->interface->updater(sensor);
  562. if(sensor->status != UT_SENSORSTATUS_OK && sensor->status != UT_SENSORSTATUS_POLLING) {
  563. UNITEMP_DEBUG("Sensor %s update status %d", sensor->name, sensor->status);
  564. }
  565. if(sensor->status == UT_SENSORSTATUS_OK) {
  566. if(app->settings.heat_index &&
  567. ((sensor->type->datatype & (UT_TEMPERATURE | UT_HUMIDITY)) ==
  568. (UT_TEMPERATURE | UT_HUMIDITY))) {
  569. unitemp_calculate_heat_index(sensor);
  570. }
  571. if(app->settings.temp_unit == UT_TEMP_FAHRENHEIT) {
  572. uintemp_celsiumToFarengate(sensor);
  573. }
  574. sensor->temp += sensor->temp_offset / 10.f;
  575. if(app->settings.pressure_unit == UT_PRESSURE_MM_HG) {
  576. unitemp_pascalToMmHg(sensor);
  577. } else if(app->settings.pressure_unit == UT_PRESSURE_IN_HG) {
  578. unitemp_pascalToInHg(sensor);
  579. } else if(app->settings.pressure_unit == UT_PRESSURE_KPA) {
  580. unitemp_pascalToKPa(sensor);
  581. }
  582. }
  583. return sensor->status;
  584. }
  585. void unitemp_sensors_updateValues(void) {
  586. for(uint8_t i = 0; i < unitemp_sensors_getCount(); i++) {
  587. unitemp_sensor_updateData(unitemp_sensor_getActive(i));
  588. }
  589. }