mirror of
https://github.com/DarkFlippers/unleashed-firmware
synced 2024-12-24 03:33:08 +00:00
274c12fc56
* Streams: string stream * String stream: updated insert/delete api * Streams: generic stream interface and string stream implementation * Streams: helpers for insert and delete_and_insert * FFF: now compatible with streams * MinUnit: introduced tests with arguments * FFF: stream access violation * Streams: copy data between streams * Streams: file stream * FFF: documentation * FFStream: documentation * FFF: alloc as file * MinUnit: support for nested tests * Streams: changed delete_and_insert, now it returns success flag. Added ability dump stream inner parameters and data to cout. * FFF: simplified file open function * Streams: unit tests * FFF: tests * Streams: declare cache_size constant as define, to allow variable modified arrays * FFF: lib moved to a separate folder * iButton: new FFF * RFID: new FFF * Animations: new FFF * IR: new FFF * NFC: new FFF * Flipper file format: delete lib * U2F: new FFF * Subghz: new FFF and streams * Streams: read line * Streams: split * FuriCore: implement memset with extra asserts * FuriCore: implement extra heap asserts without inventing memset * Scene manager: protected access to the scene id stack with a size check * NFC worker: dirty fix for issue where hal_nfc was busy on app start * Furi: update allocator to erase memory on allocation. Replace furi_alloc with malloc. * FuriCore: cleanup memmgr code. * Furi HAL: furi_hal_init is split into critical and non-critical parts. The critical part is currently clock and console. * Memmgr: added ability to track allocations and deallocations through console. * FFStream: some speedup * Streams, FF: minor fixes * Tests: restore * File stream: a slightly more thread-safe version of file_stream_delete_and_insert Co-authored-by: Aleksandr Kutuzov <alleteam@gmail.com>
266 lines
9 KiB
C
266 lines
9 KiB
C
#include "subghz_test_packet.h"
|
|
#include "../subghz_i.h"
|
|
#include "../helpers/subghz_testing.h"
|
|
|
|
#include <math.h>
|
|
#include <furi.h>
|
|
#include <furi_hal.h>
|
|
#include <input/input.h>
|
|
#include <toolbox/level_duration.h>
|
|
#include <lib/subghz/protocols/subghz_protocol_princeton.h>
|
|
|
|
#define SUBGHZ_TEST_PACKET_COUNT 500
|
|
|
|
struct SubghzTestPacket {
|
|
View* view;
|
|
osTimerId_t timer;
|
|
|
|
SubGhzDecoderPrinceton* decoder;
|
|
SubGhzEncoderPrinceton* encoder;
|
|
volatile size_t packet_rx;
|
|
SubghzTestPacketCallback callback;
|
|
void* context;
|
|
};
|
|
|
|
typedef enum {
|
|
SubghzTestPacketModelStatusRx,
|
|
SubghzTestPacketModelStatusOnlyRx,
|
|
SubghzTestPacketModelStatusTx,
|
|
} SubghzTestPacketModelStatus;
|
|
|
|
typedef struct {
|
|
uint8_t frequency;
|
|
uint32_t real_frequency;
|
|
FuriHalSubGhzPath path;
|
|
float rssi;
|
|
size_t packets;
|
|
SubghzTestPacketModelStatus status;
|
|
} SubghzTestPacketModel;
|
|
|
|
volatile bool subghz_test_packet_overrun = false;
|
|
|
|
void subghz_test_packet_set_callback(
|
|
SubghzTestPacket* subghz_test_packet,
|
|
SubghzTestPacketCallback callback,
|
|
void* context) {
|
|
furi_assert(subghz_test_packet);
|
|
furi_assert(callback);
|
|
subghz_test_packet->callback = callback;
|
|
subghz_test_packet->context = context;
|
|
}
|
|
|
|
static void subghz_test_packet_rx_callback(bool level, uint32_t duration, void* context) {
|
|
furi_assert(context);
|
|
SubghzTestPacket* instance = context;
|
|
subghz_decoder_princeton_parse(instance->decoder, level, duration);
|
|
}
|
|
|
|
static void subghz_test_packet_rx_pt_callback(SubGhzProtocolCommon* parser, void* context) {
|
|
furi_assert(context);
|
|
SubghzTestPacket* instance = context;
|
|
instance->packet_rx++;
|
|
}
|
|
|
|
static void subghz_test_packet_rssi_timer_callback(void* context) {
|
|
furi_assert(context);
|
|
SubghzTestPacket* instance = context;
|
|
|
|
with_view_model(
|
|
instance->view, (SubghzTestPacketModel * model) {
|
|
if(model->status == SubghzTestPacketModelStatusRx) {
|
|
model->rssi = furi_hal_subghz_get_rssi();
|
|
model->packets = instance->packet_rx;
|
|
} else if(model->status == SubghzTestPacketModelStatusTx) {
|
|
model->packets = SUBGHZ_TEST_PACKET_COUNT -
|
|
subghz_encoder_princeton_get_repeat_left(instance->encoder);
|
|
}
|
|
return true;
|
|
});
|
|
}
|
|
|
|
static void subghz_test_packet_draw(Canvas* canvas, SubghzTestPacketModel* model) {
|
|
char buffer[64];
|
|
|
|
canvas_set_color(canvas, ColorBlack);
|
|
canvas_set_font(canvas, FontPrimary);
|
|
canvas_draw_str(canvas, 0, 8, "CC1101 Packet Test");
|
|
|
|
canvas_set_font(canvas, FontSecondary);
|
|
// Frequency
|
|
snprintf(
|
|
buffer,
|
|
sizeof(buffer),
|
|
"Freq: %03ld.%03ld.%03ld Hz",
|
|
model->real_frequency / 1000000 % 1000,
|
|
model->real_frequency / 1000 % 1000,
|
|
model->real_frequency % 1000);
|
|
canvas_draw_str(canvas, 0, 20, buffer);
|
|
// Path
|
|
char* path_name = "Unknown";
|
|
if(model->path == FuriHalSubGhzPathIsolate) {
|
|
path_name = "isolate";
|
|
} else if(model->path == FuriHalSubGhzPath433) {
|
|
path_name = "433MHz";
|
|
} else if(model->path == FuriHalSubGhzPath315) {
|
|
path_name = "315MHz";
|
|
} else if(model->path == FuriHalSubGhzPath868) {
|
|
path_name = "868MHz";
|
|
}
|
|
snprintf(buffer, sizeof(buffer), "Path: %d - %s", model->path, path_name);
|
|
canvas_draw_str(canvas, 0, 31, buffer);
|
|
|
|
snprintf(buffer, sizeof(buffer), "Packets: %d", model->packets);
|
|
canvas_draw_str(canvas, 0, 42, buffer);
|
|
|
|
if(model->status == SubghzTestPacketModelStatusRx) {
|
|
snprintf(
|
|
buffer,
|
|
sizeof(buffer),
|
|
"RSSI: %ld.%ld dBm",
|
|
(int32_t)(model->rssi),
|
|
(int32_t)fabs(model->rssi * 10) % 10);
|
|
canvas_draw_str(canvas, 0, 53, buffer);
|
|
} else {
|
|
canvas_draw_str(canvas, 0, 53, "TX");
|
|
}
|
|
}
|
|
|
|
static bool subghz_test_packet_input(InputEvent* event, void* context) {
|
|
furi_assert(context);
|
|
SubghzTestPacket* instance = context;
|
|
|
|
if(event->key == InputKeyBack || event->type != InputTypeShort) {
|
|
return false;
|
|
}
|
|
|
|
with_view_model(
|
|
instance->view, (SubghzTestPacketModel * model) {
|
|
if(model->status == SubghzTestPacketModelStatusRx) {
|
|
furi_hal_subghz_stop_async_rx();
|
|
} else if(model->status == SubghzTestPacketModelStatusTx) {
|
|
subghz_encoder_princeton_stop(instance->encoder, millis());
|
|
furi_hal_subghz_stop_async_tx();
|
|
}
|
|
|
|
if(event->key == InputKeyLeft) {
|
|
if(model->frequency > 0) model->frequency--;
|
|
} else if(event->key == InputKeyRight) {
|
|
if(model->frequency < subghz_frequencies_count_testing - 1) model->frequency++;
|
|
} else if(event->key == InputKeyDown) {
|
|
if(model->path > 0) model->path--;
|
|
} else if(event->key == InputKeyUp) {
|
|
if(model->path < FuriHalSubGhzPath868) model->path++;
|
|
} else if(event->key == InputKeyOk) {
|
|
if(model->status == SubghzTestPacketModelStatusRx) {
|
|
model->status = SubghzTestPacketModelStatusTx;
|
|
} else {
|
|
model->status = SubghzTestPacketModelStatusRx;
|
|
}
|
|
}
|
|
|
|
model->real_frequency =
|
|
furi_hal_subghz_set_frequency(subghz_frequencies_testing[model->frequency]);
|
|
furi_hal_subghz_set_path(model->path);
|
|
|
|
if(model->status == SubghzTestPacketModelStatusRx) {
|
|
furi_hal_subghz_start_async_rx(subghz_test_packet_rx_callback, instance);
|
|
} else {
|
|
subghz_encoder_princeton_set(
|
|
instance->encoder,
|
|
0x00AABBCC,
|
|
SUBGHZ_TEST_PACKET_COUNT,
|
|
subghz_frequencies_testing[model->frequency]);
|
|
if(!furi_hal_subghz_start_async_tx(
|
|
subghz_encoder_princeton_yield, instance->encoder)) {
|
|
model->status = SubghzTestPacketModelStatusOnlyRx;
|
|
instance->callback(SubghzTestPacketEventOnlyRx, instance->context);
|
|
}
|
|
}
|
|
|
|
return true;
|
|
});
|
|
|
|
return true;
|
|
}
|
|
|
|
void subghz_test_packet_enter(void* context) {
|
|
furi_assert(context);
|
|
SubghzTestPacket* instance = context;
|
|
|
|
furi_hal_subghz_reset();
|
|
furi_hal_subghz_load_preset(FuriHalSubGhzPresetOok650Async);
|
|
|
|
with_view_model(
|
|
instance->view, (SubghzTestPacketModel * model) {
|
|
model->frequency = subghz_frequencies_433_92_testing;
|
|
model->real_frequency =
|
|
furi_hal_subghz_set_frequency(subghz_frequencies_testing[model->frequency]);
|
|
model->path = FuriHalSubGhzPathIsolate; // isolate
|
|
model->rssi = 0.0f;
|
|
model->status = SubghzTestPacketModelStatusRx;
|
|
return true;
|
|
});
|
|
|
|
furi_hal_subghz_start_async_rx(subghz_test_packet_rx_callback, instance);
|
|
|
|
osTimerStart(instance->timer, osKernelGetTickFreq() / 4);
|
|
}
|
|
|
|
void subghz_test_packet_exit(void* context) {
|
|
furi_assert(context);
|
|
SubghzTestPacket* instance = context;
|
|
|
|
osTimerStop(instance->timer);
|
|
|
|
// Reinitialize IC to default state
|
|
with_view_model(
|
|
instance->view, (SubghzTestPacketModel * model) {
|
|
if(model->status == SubghzTestPacketModelStatusRx) {
|
|
furi_hal_subghz_stop_async_rx();
|
|
} else if(model->status == SubghzTestPacketModelStatusTx) {
|
|
subghz_encoder_princeton_stop(instance->encoder, millis());
|
|
furi_hal_subghz_stop_async_tx();
|
|
}
|
|
return true;
|
|
});
|
|
furi_hal_subghz_sleep();
|
|
}
|
|
|
|
SubghzTestPacket* subghz_test_packet_alloc() {
|
|
SubghzTestPacket* instance = malloc(sizeof(SubghzTestPacket));
|
|
|
|
// View allocation and configuration
|
|
instance->view = view_alloc();
|
|
view_allocate_model(instance->view, ViewModelTypeLocking, sizeof(SubghzTestPacketModel));
|
|
view_set_context(instance->view, instance);
|
|
view_set_draw_callback(instance->view, (ViewDrawCallback)subghz_test_packet_draw);
|
|
view_set_input_callback(instance->view, subghz_test_packet_input);
|
|
view_set_enter_callback(instance->view, subghz_test_packet_enter);
|
|
view_set_exit_callback(instance->view, subghz_test_packet_exit);
|
|
|
|
instance->timer =
|
|
osTimerNew(subghz_test_packet_rssi_timer_callback, osTimerPeriodic, instance, NULL);
|
|
|
|
instance->decoder = subghz_decoder_princeton_alloc();
|
|
subghz_protocol_common_set_callback(
|
|
(SubGhzProtocolCommon*)instance->decoder, subghz_test_packet_rx_pt_callback, instance);
|
|
instance->encoder = subghz_encoder_princeton_alloc();
|
|
|
|
return instance;
|
|
}
|
|
|
|
void subghz_test_packet_free(SubghzTestPacket* instance) {
|
|
furi_assert(instance);
|
|
|
|
subghz_decoder_princeton_free(instance->decoder);
|
|
subghz_encoder_princeton_free(instance->encoder);
|
|
|
|
osTimerDelete(instance->timer);
|
|
view_free(instance->view);
|
|
free(instance);
|
|
}
|
|
|
|
View* subghz_test_packet_get_view(SubghzTestPacket* instance) {
|
|
furi_assert(instance);
|
|
return instance->view;
|
|
}
|