584c0962d8
* FURI stdglue: stdout hooks, local and global, ISR safe printf. Uniform newlines for terminal/debug output. Power: prevent sleep while core 2 has not started. * Furi record, stdglue: check mutex allocation * remove unused test * Furi stdglue: buferized output, dynamically allocated state. Furi record: dynamically allocated state. Input dump: proper line ending. Hal VCP: dynamically allocated state. * Interrupt manager: explicitly init list. * Makefile: cleanup rules, fix broken dfu upload. F4: add compiler stack protection options. * BLE: call debug uart callback on transmission complete * FreeRTOS: add configUSE_NEWLIB_REENTRANT * API HAL Timebase: fix issue with idle thread stack corruption caused by systick interrupt. BT: cleanup debug info output. FreeRTOS: disable reentry for newlib. * F4: update stack protection CFLAGS to match used compiller * F4: disable compiller stack protection because of incompatibility with current compiller * Makefile: return openocd logs to gdb * BLE: fixed pin, moar power, ble trace info. * Prevent sleep when connection is active * Makefile: return serial port to upload rule, add workaround for mac os * Furi: prevent usage of stack for cmsis functions. * F4: add missing includes, add debugger breakpoints * Applications: per app stack size. * Furi: honor kernel state in stdglue * FreeRTOS: remove unused hooks * Cleanup and format sources Co-authored-by: DrZlo13 <who.just.the.doctor@gmail.com>
71 lines
1.8 KiB
C
71 lines
1.8 KiB
C
#include <furi.h>
|
|
|
|
void prepare_data(uint32_t ID, uint32_t VENDOR, uint8_t* data) {
|
|
uint8_t value[10];
|
|
|
|
// vendor rows (4 bit in a row)
|
|
value[0] = (VENDOR >> 4) & 0xF;
|
|
value[1] = VENDOR & 0xF;
|
|
|
|
const uint8_t ROW_SIZE = 4;
|
|
const uint8_t HEADER_SIZE = 9;
|
|
|
|
// ID rows (4 bit in a row)
|
|
for(int i = 0; i < 8; i++) {
|
|
value[i + 2] = (ID >> (28 - i * ROW_SIZE)) & 0xF;
|
|
}
|
|
|
|
for(uint8_t i = 0; i < HEADER_SIZE; i++) {
|
|
data[i] = 1; // header
|
|
}
|
|
|
|
for(uint8_t i = 0; i < 10; i++) { // data
|
|
for(uint8_t j = 0; j < ROW_SIZE; j++) {
|
|
data[HEADER_SIZE + i * (ROW_SIZE + 1) + j] = (value[i] >> ((ROW_SIZE - 1) - j)) & 1;
|
|
}
|
|
|
|
// row parity
|
|
data[HEADER_SIZE + i * (ROW_SIZE + 1) + ROW_SIZE] =
|
|
(data[HEADER_SIZE + i * (ROW_SIZE + 1) + 0] +
|
|
data[HEADER_SIZE + i * (ROW_SIZE + 1) + 1] +
|
|
data[HEADER_SIZE + i * (ROW_SIZE + 1) + 2] +
|
|
data[HEADER_SIZE + i * (ROW_SIZE + 1) + 3]) %
|
|
2;
|
|
}
|
|
|
|
for(uint8_t i = 0; i < ROW_SIZE; i++) { //checksum
|
|
uint8_t checksum = 0;
|
|
for(uint8_t j = 0; j < 10; j++) {
|
|
checksum += data[HEADER_SIZE + i + j * (ROW_SIZE + 1)];
|
|
}
|
|
data[i + 59] = checksum % 2;
|
|
}
|
|
|
|
data[63] = 0; // stop bit
|
|
|
|
/*
|
|
printf("em data: ");
|
|
for(uint8_t i = 0; i < 64; i++) {
|
|
printf("%d ", data[i]);
|
|
}
|
|
printf("\r\n");
|
|
*/
|
|
}
|
|
|
|
void em4100_emulation(uint8_t* data, GpioPin* pin) {
|
|
taskENTER_CRITICAL();
|
|
gpio_write(pin, true);
|
|
|
|
for(uint8_t i = 0; i < 8; i++) {
|
|
for(uint8_t j = 0; j < 64; j++) {
|
|
delay_us(260);
|
|
gpio_write(pin, data[j]);
|
|
delay_us(260);
|
|
gpio_write(pin, !data[j]);
|
|
}
|
|
}
|
|
|
|
gpio_write(pin, false);
|
|
taskEXIT_CRITICAL();
|
|
}
|