123 lines
3.3 KiB
C++
123 lines
3.3 KiB
C++
#include "encoder-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);
|
|
}
|
|
|
|
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;
|
|
*polarity = current_polarity;
|
|
|
|
bit_clock_index++;
|
|
if(bit_clock_index >= clock_per_bit) {
|
|
bit_clock_index = 0;
|
|
|
|
bool current_bit = (card_data >> (63 - card_data_index)) & 1;
|
|
|
|
if(current_bit != last_bit) {
|
|
current_polarity = !current_polarity;
|
|
}
|
|
|
|
last_bit = current_bit;
|
|
|
|
card_data_index++;
|
|
if(card_data_index >= 64) {
|
|
card_data_index = 0;
|
|
}
|
|
}
|
|
}
|