252 lines
		
	
	
		
			8.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			252 lines
		
	
	
		
			8.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| #include "protocol_ds1996.h"
 | |
| 
 | |
| #include <core/core_defines.h>
 | |
| #include <toolbox/pretty_format.h>
 | |
| 
 | |
| #include "dallas_common.h"
 | |
| 
 | |
| #define DS1996_FAMILY_CODE 0x0CU
 | |
| #define DS1996_FAMILY_NAME "DS1996"
 | |
| 
 | |
| #define DS1996_SRAM_DATA_SIZE 8192U
 | |
| #define DS1996_SRAM_PAGE_SIZE 32U
 | |
| #define DS1996_COPY_SCRATCH_TIMEOUT_US 100U
 | |
| 
 | |
| #define DS1996_DATA_BYTE_COUNT 4U
 | |
| 
 | |
| #define DS1996_SRAM_DATA_KEY "Sram Data"
 | |
| #define DS1996_MEMORY_TYPE "SRAM"
 | |
| 
 | |
| typedef struct {
 | |
|     OneWireSlave* bus;
 | |
|     DallasCommonCommandState command_state;
 | |
| } DS1996ProtocolState;
 | |
| 
 | |
| typedef struct {
 | |
|     DallasCommonRomData rom_data;
 | |
|     uint8_t sram_data[DS1996_SRAM_DATA_SIZE];
 | |
|     DS1996ProtocolState state;
 | |
| } DS1996ProtocolData;
 | |
| 
 | |
| static bool dallas_ds1996_read(OneWireHost*, void*);
 | |
| static bool dallas_ds1996_write_copy(OneWireHost*, iButtonProtocolData*);
 | |
| static void dallas_ds1996_emulate(OneWireSlave*, iButtonProtocolData*);
 | |
| static bool dallas_ds1996_load(FlipperFormat*, uint32_t, iButtonProtocolData*);
 | |
| static bool dallas_ds1996_save(FlipperFormat*, const iButtonProtocolData*);
 | |
| static void dallas_ds1996_render_data(FuriString*, const iButtonProtocolData*);
 | |
| static void dallas_ds1996_render_brief_data(FuriString*, const iButtonProtocolData*);
 | |
| static void dallas_ds1996_render_error(FuriString*, const iButtonProtocolData*);
 | |
| static bool dallas_ds1996_is_data_valid(const iButtonProtocolData*);
 | |
| static void dallas_ds1996_get_editable_data(iButtonEditableData*, iButtonProtocolData*);
 | |
| static void dallas_ds1996_apply_edits(iButtonProtocolData*);
 | |
| 
 | |
| const iButtonProtocolDallasBase ibutton_protocol_ds1996 = {
 | |
|     .family_code = DS1996_FAMILY_CODE,
 | |
|     .features = iButtonProtocolFeatureExtData | iButtonProtocolFeatureWriteCopy,
 | |
|     .data_size = sizeof(DS1996ProtocolData),
 | |
|     .manufacturer = DALLAS_COMMON_MANUFACTURER_NAME,
 | |
|     .name = DS1996_FAMILY_NAME,
 | |
| 
 | |
|     .read = dallas_ds1996_read,
 | |
|     .write_blank = NULL, /* Data too big for known blanks */
 | |
|     .write_copy = dallas_ds1996_write_copy,
 | |
|     .emulate = dallas_ds1996_emulate,
 | |
|     .save = dallas_ds1996_save,
 | |
|     .load = dallas_ds1996_load,
 | |
|     .render_data = dallas_ds1996_render_data,
 | |
|     .render_brief_data = dallas_ds1996_render_brief_data,
 | |
|     .render_error = dallas_ds1996_render_error,
 | |
|     .is_valid = dallas_ds1996_is_data_valid,
 | |
|     .get_editable_data = dallas_ds1996_get_editable_data,
 | |
|     .apply_edits = dallas_ds1996_apply_edits,
 | |
| };
 | |
| 
 | |
| bool dallas_ds1996_read(OneWireHost* host, iButtonProtocolData* protocol_data) {
 | |
|     DS1996ProtocolData* data = protocol_data;
 | |
|     bool success = false;
 | |
| 
 | |
|     do {
 | |
|         if(!onewire_host_reset(host)) break;
 | |
|         if(!dallas_common_read_rom(host, &data->rom_data)) break;
 | |
|         if(!onewire_host_reset(host)) break;
 | |
| 
 | |
|         onewire_host_write(host, DALLAS_COMMON_CMD_OVERDRIVE_SKIP_ROM);
 | |
|         onewire_host_set_overdrive(host, true);
 | |
| 
 | |
|         if(!dallas_common_read_mem(host, 0, data->sram_data, DS1996_SRAM_DATA_SIZE)) break;
 | |
|         success = true;
 | |
|     } while(false);
 | |
| 
 | |
|     onewire_host_set_overdrive(host, false);
 | |
|     return success;
 | |
| }
 | |
| 
 | |
| bool dallas_ds1996_write_copy(OneWireHost* host, iButtonProtocolData* protocol_data) {
 | |
|     DS1996ProtocolData* data = protocol_data;
 | |
|     bool success = false;
 | |
| 
 | |
|     do {
 | |
|         if(!onewire_host_reset(host)) break;
 | |
| 
 | |
|         onewire_host_write(host, DALLAS_COMMON_CMD_OVERDRIVE_SKIP_ROM);
 | |
|         onewire_host_set_overdrive(host, true);
 | |
| 
 | |
|         if(!dallas_common_write_mem(
 | |
|                host,
 | |
|                DS1996_COPY_SCRATCH_TIMEOUT_US,
 | |
|                DS1996_SRAM_PAGE_SIZE,
 | |
|                data->sram_data,
 | |
|                DS1996_SRAM_DATA_SIZE))
 | |
|             break;
 | |
|         success = true;
 | |
|     } while(false);
 | |
| 
 | |
|     onewire_host_set_overdrive(host, false);
 | |
|     return success;
 | |
| }
 | |
| 
 | |
| static bool dallas_ds1996_reset_callback(bool is_short, void* context) {
 | |
|     furi_assert(context);
 | |
|     DS1996ProtocolData* data = context;
 | |
|     data->state.command_state = DallasCommonCommandStateIdle;
 | |
|     onewire_slave_set_overdrive(data->state.bus, is_short);
 | |
|     return true;
 | |
| }
 | |
| 
 | |
| static bool dallas_ds1996_command_callback(uint8_t command, void* context) {
 | |
|     furi_assert(context);
 | |
|     DS1996ProtocolData* data = context;
 | |
|     OneWireSlave* bus = data->state.bus;
 | |
| 
 | |
|     switch(command) {
 | |
|     case DALLAS_COMMON_CMD_SEARCH_ROM:
 | |
|         if(data->state.command_state == DallasCommonCommandStateIdle) {
 | |
|             data->state.command_state = DallasCommonCommandStateRomCmd;
 | |
|             return dallas_common_emulate_search_rom(bus, &data->rom_data);
 | |
| 
 | |
|         } else if(data->state.command_state == DallasCommonCommandStateRomCmd) {
 | |
|             data->state.command_state = DallasCommonCommandStateMemCmd;
 | |
|             return dallas_common_emulate_read_mem(bus, data->sram_data, DS1996_SRAM_DATA_SIZE);
 | |
| 
 | |
|         } else {
 | |
|             return false;
 | |
|         }
 | |
| 
 | |
|     case DALLAS_COMMON_CMD_READ_ROM:
 | |
|         if(data->state.command_state == DallasCommonCommandStateIdle) {
 | |
|             data->state.command_state = DallasCommonCommandStateRomCmd;
 | |
|             return dallas_common_emulate_read_rom(bus, &data->rom_data);
 | |
|         } else {
 | |
|             return false;
 | |
|         }
 | |
| 
 | |
|     case DALLAS_COMMON_CMD_SKIP_ROM:
 | |
|         if(data->state.command_state == DallasCommonCommandStateIdle) {
 | |
|             data->state.command_state = DallasCommonCommandStateRomCmd;
 | |
|             return true;
 | |
|         } else {
 | |
|             return false;
 | |
|         }
 | |
| 
 | |
|     case DALLAS_COMMON_CMD_OVERDRIVE_SKIP_ROM:
 | |
|         if(data->state.command_state == DallasCommonCommandStateIdle) {
 | |
|             data->state.command_state = DallasCommonCommandStateRomCmd;
 | |
|             onewire_slave_set_overdrive(bus, true);
 | |
|             return true;
 | |
|         } else {
 | |
|             return false;
 | |
|         }
 | |
| 
 | |
|     case DALLAS_COMMON_CMD_MATCH_ROM:
 | |
|     case DALLAS_COMMON_CMD_OVERDRIVE_MATCH_ROM:
 | |
|         /* TODO FL-3533: Match ROM command support */
 | |
|     default:
 | |
|         return false;
 | |
|     }
 | |
| }
 | |
| 
 | |
| void dallas_ds1996_emulate(OneWireSlave* bus, iButtonProtocolData* protocol_data) {
 | |
|     DS1996ProtocolData* data = protocol_data;
 | |
|     data->state.bus = bus;
 | |
| 
 | |
|     onewire_slave_set_reset_callback(bus, dallas_ds1996_reset_callback, protocol_data);
 | |
|     onewire_slave_set_command_callback(bus, dallas_ds1996_command_callback, protocol_data);
 | |
| }
 | |
| 
 | |
| bool dallas_ds1996_load(
 | |
|     FlipperFormat* ff,
 | |
|     uint32_t format_version,
 | |
|     iButtonProtocolData* protocol_data) {
 | |
|     DS1996ProtocolData* data = protocol_data;
 | |
|     bool success = false;
 | |
| 
 | |
|     do {
 | |
|         if(format_version < 2) break;
 | |
|         if(!dallas_common_load_rom_data(ff, format_version, &data->rom_data)) break;
 | |
|         if(!flipper_format_read_hex(
 | |
|                ff, DS1996_SRAM_DATA_KEY, data->sram_data, DS1996_SRAM_DATA_SIZE))
 | |
|             break;
 | |
|         success = true;
 | |
|     } while(false);
 | |
| 
 | |
|     return success;
 | |
| }
 | |
| 
 | |
| bool dallas_ds1996_save(FlipperFormat* ff, const iButtonProtocolData* protocol_data) {
 | |
|     const DS1996ProtocolData* data = protocol_data;
 | |
|     bool success = false;
 | |
| 
 | |
|     do {
 | |
|         if(!dallas_common_save_rom_data(ff, &data->rom_data)) break;
 | |
|         if(!flipper_format_write_hex(
 | |
|                ff, DS1996_SRAM_DATA_KEY, data->sram_data, DS1996_SRAM_DATA_SIZE))
 | |
|             break;
 | |
|         success = true;
 | |
|     } while(false);
 | |
| 
 | |
|     return success;
 | |
| }
 | |
| 
 | |
| void dallas_ds1996_render_data(FuriString* result, const iButtonProtocolData* protocol_data) {
 | |
|     const DS1996ProtocolData* data = protocol_data;
 | |
| 
 | |
|     pretty_format_bytes_hex_canonical(
 | |
|         result,
 | |
|         DS1996_DATA_BYTE_COUNT,
 | |
|         PRETTY_FORMAT_FONT_MONOSPACE,
 | |
|         data->sram_data,
 | |
|         DS1996_SRAM_DATA_SIZE);
 | |
| }
 | |
| 
 | |
| void dallas_ds1996_render_brief_data(FuriString* result, const iButtonProtocolData* protocol_data) {
 | |
|     const DS1996ProtocolData* data = protocol_data;
 | |
|     dallas_common_render_brief_data(
 | |
|         result, &data->rom_data, data->sram_data, DS1996_SRAM_DATA_SIZE, DS1996_MEMORY_TYPE);
 | |
| }
 | |
| 
 | |
| void dallas_ds1996_render_error(FuriString* result, const iButtonProtocolData* protocol_data) {
 | |
|     const DS1996ProtocolData* data = protocol_data;
 | |
| 
 | |
|     if(!dallas_common_is_valid_crc(&data->rom_data)) {
 | |
|         dallas_common_render_crc_error(result, &data->rom_data);
 | |
|     }
 | |
| }
 | |
| 
 | |
| bool dallas_ds1996_is_data_valid(const iButtonProtocolData* protocol_data) {
 | |
|     const DS1996ProtocolData* data = protocol_data;
 | |
|     return dallas_common_is_valid_crc(&data->rom_data);
 | |
| }
 | |
| 
 | |
| void dallas_ds1996_get_editable_data(
 | |
|     iButtonEditableData* editable_data,
 | |
|     iButtonProtocolData* protocol_data) {
 | |
|     DS1996ProtocolData* data = protocol_data;
 | |
|     editable_data->ptr = data->rom_data.bytes;
 | |
|     editable_data->size = sizeof(DallasCommonRomData);
 | |
| }
 | |
| 
 | |
| void dallas_ds1996_apply_edits(iButtonProtocolData* protocol_data) {
 | |
|     DS1996ProtocolData* data = protocol_data;
 | |
|     dallas_common_apply_edits(&data->rom_data, DS1996_FAMILY_CODE);
 | |
| }
 | 
