liz/flipperzero-firmware
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

[FL-1059] T5577 write (#463)

Browse Source 
* Api-hal-gpio: extend init functions
* App Lfrfid: separate protocol layer
* App Lfrfid: write EM key scene
* App Lfrfid: syntax fix
This commit is contained in:
SG
2021-05-18 18:37:47 +10:00
committed by GitHub
parent 588480831a
commit 618ddfcd04
28 changed files with 956 additions and 420 deletions
Download Patch File Download Diff File Expand all files Collapse all files

92
applications/lf-rfid/helpers/encoder-indala-40134.cpp
View File

@@ -1,102 +1,16 @@
#include "encoder-indala-40134.h"
#include "protocols/protocol-indala-40134.h"
#include <furi.h>
void EncoderIndala_40134::init(const uint8_t* data, const uint8_t data_size) {
furi_check(data_size == 3);
uint32_t fc_and_card = (data[0] << 16) | (data[1] << 8) | data[2];
card_data = 0;
// preamble
set_bit(1, 0);
set_bit(1, 2);
set_bit(1, 32);
// factory code
set_bit(((fc_and_card >> 23) & 1), 57);
set_bit(((fc_and_card >> 22) & 1), 49);
set_bit(((fc_and_card >> 21) & 1), 44);
set_bit(((fc_and_card >> 20) & 1), 47);
set_bit(((fc_and_card >> 19) & 1), 48);
set_bit(((fc_and_card >> 18) & 1), 53);
set_bit(((fc_and_card >> 17) & 1), 39);
set_bit(((fc_and_card >> 16) & 1), 58);
// card number
set_bit(((fc_and_card >> 15) & 1), 42);
set_bit(((fc_and_card >> 14) & 1), 45);
set_bit(((fc_and_card >> 13) & 1), 43);
set_bit(((fc_and_card >> 12) & 1), 40);
set_bit(((fc_and_card >> 11) & 1), 52);
set_bit(((fc_and_card >> 10) & 1), 36);
set_bit(((fc_and_card >> 9) & 1), 35);
set_bit(((fc_and_card >> 8) & 1), 51);
set_bit(((fc_and_card >> 7) & 1), 46);
set_bit(((fc_and_card >> 6) & 1), 33);
set_bit(((fc_and_card >> 5) & 1), 37);
set_bit(((fc_and_card >> 4) & 1), 54);
set_bit(((fc_and_card >> 3) & 1), 56);
set_bit(((fc_and_card >> 2) & 1), 59);
set_bit(((fc_and_card >> 1) & 1), 50);
set_bit(((fc_and_card >> 0) & 1), 41);
// checksum
uint8_t checksum = 0;
checksum += ((fc_and_card >> 14) & 1);
checksum += ((fc_and_card >> 12) & 1);
checksum += ((fc_and_card >> 9) & 1);
checksum += ((fc_and_card >> 8) & 1);
checksum += ((fc_and_card >> 6) & 1);
checksum += ((fc_and_card >> 5) & 1);
checksum += ((fc_and_card >> 2) & 1);
checksum += ((fc_and_card >> 0) & 1);
// wiegand parity bits
// even parity sum calculation (high 12 bits of data)
uint8_t even_parity_sum = 0;
for(int8_t i = 12; i < 24; i++) {
if(((fc_and_card >> i) & 1) == 1) {
even_parity_sum++;
}
}
// odd parity sum calculation (low 12 bits of data)
uint8_t odd_parity_sum = 1;
for(int8_t i = 0; i < 12; i++) {
if(((fc_and_card >> i) & 1) == 1) {
odd_parity_sum++;
}
}
// even parity bit
set_bit((even_parity_sum % 2), 34);
// odd parity bit
set_bit((odd_parity_sum % 2), 38);
// checksum
if((checksum & 1) == 1) {
set_bit(0, 62);
set_bit(1, 63);
} else {
set_bit(1, 62);
set_bit(0, 63);
}
ProtocolIndala40134 indala;
indala.encode(data, data_size, reinterpret_cast<uint8_t*>(&card_data), sizeof(card_data));
last_bit = card_data & 1;
card_data_index = 0;
current_polarity = true;
}
void EncoderIndala_40134::set_bit(bool bit, uint8_t position) {
position = 63 - position;
if(bit) {
card_data |= 1ull << position;
} else {
card_data &= ~(1ull << position);
}
}
void EncoderIndala_40134::get_next(bool* polarity, uint16_t* period, uint16_t* pulse) {
*period = 2;
*pulse = 1;