OneWireSensor.c 14 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364
  1. //Использован код Дмитрия Погребняка: https://aterlux.ru/article/1wire
  2. #include "OneWireSensor.h"
  3. #include <furi.h>
  4. #include <furi_hal.h>
  5. #include <one_wire/one_wire_host.h>
  6. const SensorType DS18x2x = {
  7. .typename = "DS18x2x",
  8. .interface = &ONE_WIRE,
  9. .pollingInterval = 250,
  10. .allocator = unitemp_onewire_sensor_alloc,
  11. .mem_releaser = unitemp_onewire_sensor_free,
  12. .initializer = unitemp_onewire_sensor_init,
  13. .deinitializer = unitemp_onewire_sensor_deinit,
  14. .updater = unitemp_onewire_sensor_update};
  15. // Переменные для хранения промежуточного результата поиска
  16. uint8_t onewire_enum[8]; // найденный восьмибайтовый адрес
  17. uint8_t onewire_enum_fork_bit; // последний нулевой бит, где была неоднозначность (нумеруя с единицы)
  18. OneWireBus* uintemp_onewire_bus_alloc(const GPIO* gpio) {
  19. if(gpio == NULL) {
  20. return NULL;
  21. }
  22. //Проверка на наличие шины на этом порте
  23. for(uint8_t i = 0; i < app->sensors_count; i++) {
  24. if(app->sensors[i]->type == &DS18x2x &&
  25. ((OneWireBus*)(app->sensors[i]->instance))->gpio == gpio) {
  26. ((OneWireBus*)(app->sensors[i]->instance))->device_count++;
  27. return ((OneWireBus*)(app->sensors[i]->instance));
  28. }
  29. }
  30. OneWireBus* bus = malloc(sizeof(OneWireBus));
  31. bus->device_count = 0;
  32. bus->gpio = gpio;
  33. bus->powerMode = PWR_ACTIVE;
  34. FURI_LOG_D(APP_NAME, "one wire bus (port %d) allocated", unitemp_gpio_toInt(gpio));
  35. return bus;
  36. }
  37. bool unitemp_onewire_bus_init(OneWireBus* bus) {
  38. if(bus == NULL) return false;
  39. if(bus->device_count > 0) return true;
  40. unitemp_gpio_lock(bus->gpio, &ONE_WIRE);
  41. //Высокий уровень по умолчанию
  42. furi_hal_gpio_write(bus->gpio->pin, true);
  43. //Режим работы - OpenDrain, подтяжка включается на всякий случай
  44. furi_hal_gpio_init(
  45. bus->gpio->pin, //Порт FZ
  46. GpioModeOutputOpenDrain, //Режим работы - открытый сток
  47. GpioPullUp, //Принудительная подтяжка линии данных к питанию
  48. GpioSpeedVeryHigh); //Скорость работы - максимальная
  49. bus->device_count++;
  50. return true;
  51. }
  52. bool unitemp_onewire_bus_deinit(OneWireBus* bus) {
  53. bus->device_count--;
  54. if(bus->device_count <= 0) {
  55. bus->device_count = 0;
  56. unitemp_gpio_lock(bus->gpio, &ONE_WIRE);
  57. //Режим работы - аналог, подтяжка выключена
  58. furi_hal_gpio_init(
  59. bus->gpio->pin, //Порт FZ
  60. GpioModeAnalog, //Режим работы - аналог
  61. GpioPullNo, //Подтяжка выключена
  62. GpioSpeedLow); //Скорость работы - минимальная
  63. //Низкий уровень по умолчанию
  64. furi_hal_gpio_write(bus->gpio->pin, false);
  65. return true;
  66. } else {
  67. return false;
  68. }
  69. }
  70. bool unitemp_onewire_bus_start(OneWireBus* bus) {
  71. furi_hal_gpio_write(bus->gpio->pin, false);
  72. furi_delay_us(500);
  73. furi_hal_gpio_write(bus->gpio->pin, true);
  74. //Ожидание подъёма шины
  75. uint32_t t = furi_get_tick();
  76. while(!furi_hal_gpio_read(bus->gpio->pin)) {
  77. //Выход если шина не поднялась
  78. if(furi_get_tick() - t > 100) return false;
  79. }
  80. furi_delay_us(100);
  81. bool status = !furi_hal_gpio_read(bus->gpio->pin);
  82. furi_delay_us(400);
  83. return status;
  84. }
  85. void unitemp_onewire_send_bit(OneWireBus* bus, bool state) {
  86. if(state) {
  87. // write 1
  88. furi_hal_gpio_write(bus->gpio->pin, false);
  89. furi_delay_us(1);
  90. furi_hal_gpio_write(bus->gpio->pin, true);
  91. furi_delay_us(90);
  92. } else {
  93. furi_hal_gpio_write(bus->gpio->pin, false);
  94. furi_delay_us(90);
  95. furi_hal_gpio_write(bus->gpio->pin, true);
  96. //Ожидание подъёма шины
  97. uint32_t t = furi_get_tick();
  98. while(!furi_hal_gpio_read(bus->gpio->pin)) {
  99. //Выход если шина не поднялась
  100. if(furi_get_tick() - t > 10) return;
  101. }
  102. }
  103. }
  104. void unitemp_onewire_send_byte(OneWireBus* bus, uint8_t data) {
  105. for(int i = 0; i < 8; i++) {
  106. unitemp_onewire_send_bit(bus, (data & (1 << i)) != 0);
  107. }
  108. }
  109. void unitemp_onewire_send_byteArray(OneWireBus* bus, uint8_t* data, uint8_t len) {
  110. for(uint8_t i = 0; i < len; i++) {
  111. unitemp_onewire_send_byte(bus, data[i]);
  112. }
  113. }
  114. bool unitemp_onewire_read_bit(OneWireBus* bus) {
  115. furi_hal_gpio_write(bus->gpio->pin, false);
  116. furi_delay_us(2); // Длительность низкого уровня, минимум 1 мкс
  117. furi_hal_gpio_write(bus->gpio->pin, true);
  118. furi_delay_us(8); // Пауза до момента сэмплирования, всего не более 15 мкс
  119. bool r = furi_hal_gpio_read(bus->gpio->pin);
  120. furi_delay_us(80); // Ожидание до следующего тайм-слота, минимум 60 мкс с начала низкого уровня
  121. return r;
  122. }
  123. uint8_t unitemp_onewire_read_byte(OneWireBus* bus) {
  124. uint8_t r = 0;
  125. for(uint8_t p = 8; p; p--) {
  126. r >>= 1;
  127. if(unitemp_onewire_read_bit(bus)) r |= 0x80;
  128. }
  129. return r;
  130. }
  131. void unitemp_onewire_read_byteArray(OneWireBus* bus, uint8_t* data, uint8_t len) {
  132. for(uint8_t i = 0; i < len; i++) {
  133. data[i] = unitemp_onewire_read_byte(bus);
  134. }
  135. }
  136. uint8_t onewire_CRC_update(uint8_t crc, uint8_t b) {
  137. for(uint8_t p = 8; p; p--) {
  138. crc = ((crc ^ b) & 1) ? (crc >> 1) ^ 0b10001100 : (crc >> 1);
  139. b >>= 1;
  140. }
  141. return crc;
  142. }
  143. bool unitemp_onewire_CRC_check(uint8_t* data, uint8_t len) {
  144. uint8_t crc = 0;
  145. for(uint8_t i = 0; i < len; i++) {
  146. crc = onewire_CRC_update(crc, data[i]);
  147. }
  148. return !crc;
  149. }
  150. bool unitemp_onewire_sensor_readID(OneWireSensor* instance) {
  151. if(!unitemp_onewire_bus_start(instance->bus)) return false;
  152. unitemp_onewire_send_byte(instance->bus, 0x33); // Чтение ПЗУ
  153. unitemp_onewire_read_byteArray(instance->bus, instance->deviceID, 8);
  154. if(!unitemp_onewire_CRC_check(instance->deviceID, 8)) {
  155. memset(instance->deviceID, 0, 8);
  156. return false;
  157. }
  158. instance->familyCode = instance->deviceID[0];
  159. return true;
  160. }
  161. void unitemp_onewire_enum_init(void) {
  162. for(uint8_t p = 0; p < 8; p++) {
  163. onewire_enum[p] = 0;
  164. }
  165. onewire_enum_fork_bit = 65; // правее правого
  166. }
  167. uint8_t* unitemp_onewire_enum_next(OneWireBus* bus) {
  168. furi_delay_ms(10);
  169. if(!onewire_enum_fork_bit) { // Если на предыдущем шаге уже не было разногласий
  170. FURI_LOG_D(APP_NAME, "All devices on wire %d is found", unitemp_gpio_toInt(bus->gpio));
  171. return 0; // то просто выходим ничего не возвращая
  172. }
  173. if(!unitemp_onewire_bus_start(bus)) {
  174. FURI_LOG_D(APP_NAME, "Wire %d is empty", unitemp_gpio_toInt(bus->gpio));
  175. return 0;
  176. }
  177. uint8_t bp = 8;
  178. uint8_t* pprev = &onewire_enum[0];
  179. uint8_t prev = *pprev;
  180. uint8_t next = 0;
  181. uint8_t p = 1;
  182. unitemp_onewire_send_byte(bus, 0xF0);
  183. uint8_t newfork = 0;
  184. for(;;) {
  185. uint8_t not0 = unitemp_onewire_read_bit(bus);
  186. uint8_t not1 = unitemp_onewire_read_bit(bus);
  187. if(!not0) { // Если присутствует в адресах бит ноль
  188. if(!not1) { // Но также присустствует бит 1 (вилка)
  189. if(p <
  190. onewire_enum_fork_bit) { // Если мы левее прошлого правого конфликтного бита,
  191. if(prev & 1) {
  192. next |= 0x80; // то копируем значение бита из прошлого прохода
  193. } else {
  194. newfork = p; // если ноль, то запомним конфликтное место
  195. }
  196. } else if(p == onewire_enum_fork_bit) {
  197. next |=
  198. 0x80; // если на этом месте в прошлый раз был правый конфликт с нулём, выведем 1
  199. } else {
  200. newfork = p; // правее - передаём ноль и запоминаем конфликтное место
  201. }
  202. } // в противном случае идём, выбирая ноль в адресе
  203. } else {
  204. if(!not1) { // Присутствует единица
  205. next |= 0x80;
  206. } else { // Нет ни нулей ни единиц - ошибочная ситуация
  207. FURI_LOG_D(APP_NAME, "Wrong wire %d situation", unitemp_gpio_toInt(bus->gpio));
  208. return 0;
  209. }
  210. }
  211. unitemp_onewire_send_bit(bus, next & 0x80);
  212. bp--;
  213. if(!bp) {
  214. *pprev = next;
  215. if(p >= 64) break;
  216. next = 0;
  217. pprev++;
  218. prev = *pprev;
  219. bp = 8;
  220. } else {
  221. if(p >= 64) break;
  222. prev >>= 1;
  223. next >>= 1;
  224. }
  225. p++;
  226. }
  227. onewire_enum_fork_bit = newfork;
  228. return &onewire_enum[0];
  229. }
  230. void unitemp_onewire_sensor_select(OneWireSensor* instance) {
  231. unitemp_onewire_send_byte(instance->bus, 0x55);
  232. unitemp_onewire_send_byteArray(instance->bus, instance->deviceID, 8);
  233. }
  234. bool unitemp_onewire_sensor_alloc(Sensor* sensor, char* args) {
  235. OneWireSensor* instance = malloc(sizeof(OneWireSensor));
  236. if(instance == NULL) {
  237. FURI_LOG_E(APP_NAME, "Sensor %s instance allocation error", sensor->name);
  238. return false;
  239. }
  240. sensor->instance = instance;
  241. //Очистка адреса
  242. memset(instance->deviceID, 0, 8);
  243. instance->bus = uintemp_onewire_bus_alloc(unitemp_gpio_getFromInt(args[0]));
  244. if(instance != NULL) {
  245. return true;
  246. }
  247. FURI_LOG_E(APP_NAME, "Sensor %s bus allocation error", sensor->name);
  248. free(instance);
  249. return false;
  250. }
  251. bool unitemp_onewire_sensor_free(Sensor* sensor) {
  252. if(((OneWireSensor*)sensor->instance)->bus->device_count == 0) {
  253. unitemp_gpio_unlock(((OneWireSensor*)sensor->instance)->bus->gpio);
  254. free(((OneWireSensor*)sensor->instance)->bus);
  255. }
  256. free(sensor->instance);
  257. return true;
  258. }
  259. bool unitemp_onewire_sensor_init(Sensor* sensor) {
  260. OneWireSensor* instance = sensor->instance;
  261. if(instance == NULL || instance->bus->gpio == NULL) {
  262. FURI_LOG_E(APP_NAME, "Sensor pointer is null!");
  263. return false;
  264. }
  265. unitemp_onewire_bus_init(instance->bus);
  266. furi_delay_ms(1);
  267. if(instance->familyCode == FC_DS18B20 || instance->familyCode == FC_DS1822) {
  268. //Установка разрядности в 10 бит
  269. if(!unitemp_onewire_bus_start(instance->bus)) return false;
  270. unitemp_onewire_sensor_select(instance);
  271. unitemp_onewire_send_byte(instance->bus, 0x4E); // Запись в память
  272. uint8_t buff[3];
  273. buff[0] = 0x4B; //Значение нижнего предела
  274. buff[1] = 0x46; //Значение высшего предела
  275. buff[2] = 0x3F; //10 бит разрядность преобразования
  276. unitemp_onewire_send_byteArray(instance->bus, buff, 3);
  277. //Сохранение значений в EEPROM для автоматического восстановления после сбоев питания
  278. if(!unitemp_onewire_bus_start(instance->bus)) return false;
  279. unitemp_onewire_sensor_select(instance);
  280. unitemp_onewire_send_byte(instance->bus, 0x48); // Запись в EEPROM
  281. }
  282. return true;
  283. }
  284. bool unitemp_onewire_sensor_deinit(Sensor* sensor) {
  285. OneWireSensor* instance = sensor->instance;
  286. if(instance == NULL || instance->bus->gpio == NULL) return false;
  287. unitemp_onewire_bus_deinit(instance->bus);
  288. return true;
  289. }
  290. UnitempStatus unitemp_onewire_sensor_update(Sensor* sensor) {
  291. OneWireSensor* instance = sensor->instance;
  292. if(sensor->status != UT_POLLING) {
  293. if(!unitemp_onewire_bus_start(instance->bus)) return UT_TIMEOUT;
  294. unitemp_onewire_sensor_select(instance);
  295. unitemp_onewire_send_byte(instance->bus, 0x44); // convert t
  296. if(instance->bus->powerMode == PWR_PASSIVE) {
  297. furi_hal_gpio_write(instance->bus->gpio->pin, true);
  298. furi_hal_gpio_init(
  299. instance->bus->gpio->pin, GpioModeOutputPushPull, GpioPullUp, GpioSpeedVeryHigh);
  300. }
  301. return UT_POLLING;
  302. } else {
  303. if(instance->bus->powerMode == PWR_PASSIVE) {
  304. furi_hal_gpio_write(instance->bus->gpio->pin, true);
  305. furi_hal_gpio_init(
  306. instance->bus->gpio->pin, GpioModeOutputOpenDrain, GpioPullUp, GpioSpeedVeryHigh);
  307. }
  308. if(!unitemp_onewire_bus_start(instance->bus)) return UT_TIMEOUT;
  309. unitemp_onewire_sensor_select(instance);
  310. unitemp_onewire_send_byte(instance->bus, 0xBE); // Read Scratch-pad
  311. uint8_t buff[9];
  312. unitemp_onewire_read_byteArray(instance->bus, buff, 9);
  313. if(!unitemp_onewire_CRC_check(buff, 9)) {
  314. FURI_LOG_D(APP_NAME, "Failed CRC check: %s", sensor->name);
  315. return UT_TIMEOUT;
  316. }
  317. int16_t raw = buff[0] | ((int16_t)buff[1] << 8);
  318. if(instance->familyCode == FC_DS18S20) {
  319. sensor->temp = (float)raw / 2.0f;
  320. } else {
  321. sensor->temp = (float)raw / 16.0f;
  322. }
  323. }
  324. return UT_OK;
  325. }