|
|
@@ -0,0 +1,330 @@
|
|
|
+#include <furi.h>
|
|
|
+#include <furi_hal.h>
|
|
|
+#include "ibutton_worker_i.h"
|
|
|
+#include "ibutton_key_command.h"
|
|
|
+
|
|
|
+void ibutton_worker_mode_idle_start(iButtonWorker* worker);
|
|
|
+void ibutton_worker_mode_idle_tick(iButtonWorker* worker);
|
|
|
+void ibutton_worker_mode_idle_stop(iButtonWorker* worker);
|
|
|
+
|
|
|
+void ibutton_worker_mode_emulate_start(iButtonWorker* worker);
|
|
|
+void ibutton_worker_mode_emulate_tick(iButtonWorker* worker);
|
|
|
+void ibutton_worker_mode_emulate_stop(iButtonWorker* worker);
|
|
|
+
|
|
|
+void ibutton_worker_mode_read_start(iButtonWorker* worker);
|
|
|
+void ibutton_worker_mode_read_tick(iButtonWorker* worker);
|
|
|
+void ibutton_worker_mode_read_stop(iButtonWorker* worker);
|
|
|
+
|
|
|
+void ibutton_worker_mode_write_start(iButtonWorker* worker);
|
|
|
+void ibutton_worker_mode_write_tick(iButtonWorker* worker);
|
|
|
+void ibutton_worker_mode_write_stop(iButtonWorker* worker);
|
|
|
+
|
|
|
+const iButtonWorkerModeType ibutton_worker_modes[] = {
|
|
|
+ {
|
|
|
+ .quant = osWaitForever,
|
|
|
+ .start = ibutton_worker_mode_idle_start,
|
|
|
+ .tick = ibutton_worker_mode_idle_tick,
|
|
|
+ .stop = ibutton_worker_mode_idle_stop,
|
|
|
+ },
|
|
|
+ {
|
|
|
+ .quant = 100,
|
|
|
+ .start = ibutton_worker_mode_read_start,
|
|
|
+ .tick = ibutton_worker_mode_read_tick,
|
|
|
+ .stop = ibutton_worker_mode_read_stop,
|
|
|
+ },
|
|
|
+ {
|
|
|
+ .quant = 1000,
|
|
|
+ .start = ibutton_worker_mode_write_start,
|
|
|
+ .tick = ibutton_worker_mode_write_tick,
|
|
|
+ .stop = ibutton_worker_mode_write_stop,
|
|
|
+ },
|
|
|
+ {
|
|
|
+ .quant = 1000,
|
|
|
+ .start = ibutton_worker_mode_emulate_start,
|
|
|
+ .tick = ibutton_worker_mode_emulate_tick,
|
|
|
+ .stop = ibutton_worker_mode_emulate_stop,
|
|
|
+ },
|
|
|
+};
|
|
|
+
|
|
|
+/*********************** IDLE ***********************/
|
|
|
+
|
|
|
+void ibutton_worker_mode_idle_start(iButtonWorker* worker) {
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_mode_idle_tick(iButtonWorker* worker) {
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_mode_idle_stop(iButtonWorker* worker) {
|
|
|
+}
|
|
|
+
|
|
|
+/*********************** READ ***********************/
|
|
|
+
|
|
|
+void ibutton_worker_comparator_callback(bool level, void* context) {
|
|
|
+ iButtonWorker* worker = context;
|
|
|
+
|
|
|
+ uint32_t current_dwt_value = DWT->CYCCNT;
|
|
|
+
|
|
|
+ pulse_decoder_process_pulse(
|
|
|
+ worker->pulse_decoder, level, current_dwt_value - worker->last_dwt_value);
|
|
|
+
|
|
|
+ worker->last_dwt_value = current_dwt_value;
|
|
|
+}
|
|
|
+
|
|
|
+bool ibutton_worker_read_comparator(iButtonWorker* worker) {
|
|
|
+ bool result = false;
|
|
|
+
|
|
|
+ pulse_decoder_reset(worker->pulse_decoder);
|
|
|
+
|
|
|
+ furi_hal_rfid_pins_reset();
|
|
|
+ // pulldown pull pin, we sense the signal through the analog part of the RFID schematic
|
|
|
+ furi_hal_rfid_pin_pull_pulldown();
|
|
|
+ furi_hal_rfid_comp_set_callback(ibutton_worker_comparator_callback, worker);
|
|
|
+ worker->last_dwt_value = DWT->CYCCNT;
|
|
|
+ furi_hal_rfid_comp_start();
|
|
|
+
|
|
|
+ // TODO: rework with thread events, "pulse_decoder_get_decoded_index_with_timeout"
|
|
|
+ delay(100);
|
|
|
+ int32_t decoded_index = pulse_decoder_get_decoded_index(worker->pulse_decoder);
|
|
|
+ if(decoded_index >= 0) {
|
|
|
+ pulse_decoder_get_data(
|
|
|
+ worker->pulse_decoder, decoded_index, worker->key_data, ibutton_key_get_max_size());
|
|
|
+ }
|
|
|
+
|
|
|
+ switch(decoded_index) {
|
|
|
+ case PulseProtocolCyfral:
|
|
|
+ furi_check(worker->key_p != NULL);
|
|
|
+ ibutton_key_set_type(worker->key_p, iButtonKeyCyfral);
|
|
|
+ ibutton_key_set_data(worker->key_p, worker->key_data, ibutton_key_get_max_size());
|
|
|
+ result = true;
|
|
|
+ break;
|
|
|
+ case PulseProtocolMetakom:
|
|
|
+ furi_check(worker->key_p != NULL);
|
|
|
+ ibutton_key_set_type(worker->key_p, iButtonKeyMetakom);
|
|
|
+ ibutton_key_set_data(worker->key_p, worker->key_data, ibutton_key_get_max_size());
|
|
|
+ result = true;
|
|
|
+ break;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ furi_hal_rfid_comp_stop();
|
|
|
+ furi_hal_rfid_comp_set_callback(NULL, NULL);
|
|
|
+ furi_hal_rfid_pins_reset();
|
|
|
+
|
|
|
+ return result;
|
|
|
+}
|
|
|
+
|
|
|
+bool ibutton_worker_read_dallas(iButtonWorker* worker) {
|
|
|
+ bool result = false;
|
|
|
+ onewire_host_start(worker->host);
|
|
|
+ delay(100);
|
|
|
+ FURI_CRITICAL_ENTER();
|
|
|
+ if(onewire_host_search(worker->host, worker->key_data, NORMAL_SEARCH)) {
|
|
|
+ onewire_host_reset_search(worker->host);
|
|
|
+
|
|
|
+ // key found, verify
|
|
|
+ if(onewire_host_reset(worker->host)) {
|
|
|
+ onewire_host_write(worker->host, DS1990_CMD_READ_ROM);
|
|
|
+ bool key_valid = true;
|
|
|
+ for(uint8_t i = 0; i < ibutton_key_get_max_size(); i++) {
|
|
|
+ if(onewire_host_read(worker->host) != worker->key_data[i]) {
|
|
|
+ key_valid = false;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if(key_valid) {
|
|
|
+ result = true;
|
|
|
+
|
|
|
+ furi_check(worker->key_p != NULL);
|
|
|
+ ibutton_key_set_type(worker->key_p, iButtonKeyDS1990);
|
|
|
+ ibutton_key_set_data(worker->key_p, worker->key_data, ibutton_key_get_max_size());
|
|
|
+ }
|
|
|
+ }
|
|
|
+ } else {
|
|
|
+ onewire_host_reset_search(worker->host);
|
|
|
+ }
|
|
|
+ onewire_host_stop(worker->host);
|
|
|
+ FURI_CRITICAL_EXIT();
|
|
|
+ return result;
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_mode_read_start(iButtonWorker* worker) {
|
|
|
+ furi_hal_power_enable_otg();
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_mode_read_tick(iButtonWorker* worker) {
|
|
|
+ bool valid = false;
|
|
|
+ if(ibutton_worker_read_dallas(worker)) {
|
|
|
+ valid = true;
|
|
|
+ } else if(ibutton_worker_read_comparator(worker)) {
|
|
|
+ valid = true;
|
|
|
+ }
|
|
|
+
|
|
|
+ if(valid) {
|
|
|
+ if(worker->read_cb != NULL) {
|
|
|
+ worker->read_cb(worker->cb_ctx);
|
|
|
+ }
|
|
|
+
|
|
|
+ ibutton_worker_switch_mode(worker, iButtonWorkerIdle);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_mode_read_stop(iButtonWorker* worker) {
|
|
|
+ furi_hal_power_disable_otg();
|
|
|
+}
|
|
|
+
|
|
|
+/*********************** EMULATE ***********************/
|
|
|
+static void onewire_slave_callback(void* context) {
|
|
|
+ furi_assert(context);
|
|
|
+ iButtonWorker* worker = context;
|
|
|
+ if(worker->emulate_cb != NULL) {
|
|
|
+ worker->emulate_cb(worker->cb_ctx, true);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_emulate_dallas_start(iButtonWorker* worker) {
|
|
|
+ uint8_t* device_id = onewire_device_get_id_p(worker->device);
|
|
|
+ const uint8_t* key_id = ibutton_key_get_data_p(worker->key_p);
|
|
|
+ const uint8_t key_size = ibutton_key_get_max_size();
|
|
|
+ memcpy(device_id, key_id, key_size);
|
|
|
+
|
|
|
+ onewire_slave_attach(worker->slave, worker->device);
|
|
|
+ onewire_slave_start(worker->slave);
|
|
|
+ onewire_slave_set_result_callback(worker->slave, onewire_slave_callback, worker);
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_emulate_dallas_stop(iButtonWorker* worker) {
|
|
|
+ onewire_slave_stop(worker->slave);
|
|
|
+ onewire_slave_detach(worker->slave);
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_emulate_timer_cb(void* context) {
|
|
|
+ furi_assert(context);
|
|
|
+ iButtonWorker* worker = context;
|
|
|
+
|
|
|
+ bool polarity;
|
|
|
+ uint32_t length;
|
|
|
+
|
|
|
+ switch(worker->emulate_mode) {
|
|
|
+ case iButtonEmulateModeCyfral:
|
|
|
+ encoder_cyfral_get_pulse(worker->encoder_cyfral, &polarity, &length);
|
|
|
+ break;
|
|
|
+ case iButtonEmulateModeMetakom:
|
|
|
+ encoder_metakom_get_pulse(worker->encoder_metakom, &polarity, &length);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ furi_hal_ibutton_emulate_set_next(length);
|
|
|
+
|
|
|
+ if(polarity) {
|
|
|
+ furi_hal_ibutton_pin_high();
|
|
|
+ } else {
|
|
|
+ furi_hal_ibutton_pin_low();
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_emulate_timer_start(iButtonWorker* worker) {
|
|
|
+ furi_assert(worker->key_p);
|
|
|
+ const uint8_t* key_id = ibutton_key_get_data_p(worker->key_p);
|
|
|
+ const uint8_t key_size = ibutton_key_get_max_size();
|
|
|
+
|
|
|
+ switch(ibutton_key_get_type(worker->key_p)) {
|
|
|
+ case iButtonKeyDS1990:
|
|
|
+ return;
|
|
|
+ break;
|
|
|
+ case iButtonKeyCyfral:
|
|
|
+ worker->emulate_mode = iButtonEmulateModeCyfral;
|
|
|
+ encoder_cyfral_reset(worker->encoder_cyfral);
|
|
|
+ encoder_cyfral_set_data(worker->encoder_cyfral, key_id, key_size);
|
|
|
+ break;
|
|
|
+ case iButtonKeyMetakom:
|
|
|
+ worker->emulate_mode = iButtonEmulateModeMetakom;
|
|
|
+ encoder_metakom_reset(worker->encoder_metakom);
|
|
|
+ encoder_metakom_set_data(worker->encoder_metakom, key_id, key_size);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ furi_hal_ibutton_start_drive();
|
|
|
+ furi_hal_ibutton_emulate_start(0, ibutton_worker_emulate_timer_cb, worker);
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_emulate_timer_stop(iButtonWorker* worker) {
|
|
|
+ furi_hal_ibutton_emulate_stop();
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_mode_emulate_start(iButtonWorker* worker) {
|
|
|
+ furi_assert(worker->key_p);
|
|
|
+
|
|
|
+ furi_hal_rfid_pins_reset();
|
|
|
+ furi_hal_rfid_pin_pull_pulldown();
|
|
|
+
|
|
|
+ switch(ibutton_key_get_type(worker->key_p)) {
|
|
|
+ case iButtonKeyDS1990:
|
|
|
+ ibutton_worker_emulate_dallas_start(worker);
|
|
|
+ break;
|
|
|
+ case iButtonKeyCyfral:
|
|
|
+ case iButtonKeyMetakom:
|
|
|
+ ibutton_worker_emulate_timer_start(worker);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_mode_emulate_tick(iButtonWorker* worker) {
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_mode_emulate_stop(iButtonWorker* worker) {
|
|
|
+ furi_assert(worker->key_p);
|
|
|
+
|
|
|
+ furi_hal_rfid_pins_reset();
|
|
|
+
|
|
|
+ switch(ibutton_key_get_type(worker->key_p)) {
|
|
|
+ case iButtonKeyDS1990:
|
|
|
+ ibutton_worker_emulate_dallas_stop(worker);
|
|
|
+ break;
|
|
|
+ case iButtonKeyCyfral:
|
|
|
+ case iButtonKeyMetakom:
|
|
|
+ ibutton_worker_emulate_timer_stop(worker);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*********************** WRITE ***********************/
|
|
|
+
|
|
|
+void ibutton_worker_mode_write_start(iButtonWorker* worker) {
|
|
|
+ furi_hal_power_enable_otg();
|
|
|
+ onewire_host_start(worker->host);
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_mode_write_tick(iButtonWorker* worker) {
|
|
|
+ furi_check(worker->key_p != NULL);
|
|
|
+ iButtonWriterResult writer_result = ibutton_writer_write(worker->writer, worker->key_p);
|
|
|
+ iButtonWorkerWriteResult result;
|
|
|
+ switch(writer_result) {
|
|
|
+ case iButtonWriterOK:
|
|
|
+ result = iButtonWorkerWriteOK;
|
|
|
+ break;
|
|
|
+ case iButtonWriterSameKey:
|
|
|
+ result = iButtonWorkerWriteSameKey;
|
|
|
+ break;
|
|
|
+ case iButtonWriterNoDetect:
|
|
|
+ result = iButtonWorkerWriteNoDetect;
|
|
|
+ break;
|
|
|
+ case iButtonWriterCannotWrite:
|
|
|
+ result = iButtonWorkerWriteCannotWrite;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ result = iButtonWorkerWriteNoDetect;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ if(worker->write_cb != NULL) {
|
|
|
+ worker->write_cb(worker->cb_ctx, result);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void ibutton_worker_mode_write_stop(iButtonWorker* worker) {
|
|
|
+ furi_hal_power_disable_otg();
|
|
|
+ onewire_host_stop(worker->host);
|
|
|
+}
|