mirror of
https://github.com/DarkFlippers/unleashed-firmware.git
synced 2024-12-23 21:34:35 +03:00
184 lines
5.5 KiB
C
184 lines
5.5 KiB
C
// Author: github.com/kallanreed
|
|
#include <furi.h>
|
|
#include <furi_hal.h>
|
|
#include <infrared.h>
|
|
#include <infrared_worker.h>
|
|
#include <furi_hal_infrared.h>
|
|
#include <gui/gui.h>
|
|
|
|
#define TAG "IR Scope"
|
|
#define COLS 128
|
|
#define ROWS 8
|
|
|
|
typedef struct {
|
|
bool autoscale;
|
|
uint16_t us_per_sample;
|
|
size_t timings_cnt;
|
|
uint32_t* timings;
|
|
uint32_t timings_sum;
|
|
FuriMutex* mutex;
|
|
} IRScopeState;
|
|
|
|
static void state_set_autoscale(IRScopeState* state) {
|
|
if(state->autoscale) state->us_per_sample = state->timings_sum / (ROWS * COLS);
|
|
}
|
|
|
|
static void canvas_draw_str_outline(Canvas* canvas, int x, int y, const char* str) {
|
|
canvas_set_color(canvas, ColorWhite);
|
|
for(int y1 = -1; y1 <= 1; ++y1)
|
|
for(int x1 = -1; x1 <= 1; ++x1) canvas_draw_str(canvas, x + x1, y + y1, str);
|
|
|
|
canvas_set_color(canvas, ColorBlack);
|
|
canvas_draw_str(canvas, x, y, str);
|
|
}
|
|
|
|
static void render_callback(Canvas* canvas, void* ctx) {
|
|
const IRScopeState* state = (IRScopeState*)ctx;
|
|
|
|
furi_mutex_acquire(state->mutex, FuriWaitForever);
|
|
|
|
canvas_clear(canvas);
|
|
canvas_draw_frame(canvas, 0, 0, 128, 64);
|
|
|
|
// Draw the signal chart.
|
|
bool on = false;
|
|
bool done = false;
|
|
size_t ix = 0;
|
|
int timing_cols = -1; // Count of columns used to draw the current timing
|
|
for(size_t row = 0; row < ROWS && !done; ++row) {
|
|
for(size_t col = 0; col < COLS && !done; ++col) {
|
|
done = ix >= state->timings_cnt;
|
|
|
|
if(!done && timing_cols < 0) {
|
|
timing_cols = state->timings[ix] / state->us_per_sample;
|
|
on = !on;
|
|
}
|
|
|
|
if(timing_cols == 0) ++ix;
|
|
|
|
int y = row * 8 + 7;
|
|
canvas_draw_line(canvas, col, y, col, y - (on ? 5 : 0));
|
|
--timing_cols;
|
|
}
|
|
}
|
|
|
|
canvas_set_font(canvas, FontSecondary);
|
|
if(state->autoscale)
|
|
canvas_draw_str_outline(canvas, 100, 64, "Auto");
|
|
else {
|
|
char buf[20];
|
|
snprintf(buf, sizeof(buf), "%uus", state->us_per_sample);
|
|
canvas_draw_str_outline(canvas, 100, 64, buf);
|
|
}
|
|
|
|
furi_mutex_release(state->mutex);
|
|
}
|
|
|
|
static void input_callback(InputEvent* input_event, void* ctx) {
|
|
FuriMessageQueue* event_queue = ctx;
|
|
furi_message_queue_put(event_queue, input_event, FuriWaitForever);
|
|
}
|
|
|
|
static void ir_received_callback(void* ctx, InfraredWorkerSignal* signal) {
|
|
furi_check(signal);
|
|
IRScopeState* state = (IRScopeState*)ctx;
|
|
|
|
furi_mutex_acquire(state->mutex, FuriWaitForever);
|
|
|
|
const uint32_t* timings;
|
|
infrared_worker_get_raw_signal(signal, &timings, &state->timings_cnt);
|
|
|
|
if(state->timings) {
|
|
free(state->timings);
|
|
state->timings_sum = 0;
|
|
}
|
|
|
|
state->timings = malloc(state->timings_cnt * sizeof(uint32_t));
|
|
|
|
// Copy and sum.
|
|
for(size_t i = 0; i < state->timings_cnt; ++i) {
|
|
state->timings[i] = timings[i];
|
|
state->timings_sum += timings[i];
|
|
}
|
|
|
|
state_set_autoscale(state);
|
|
|
|
furi_mutex_release(state->mutex);
|
|
}
|
|
|
|
int32_t ir_scope_app(void* p) {
|
|
UNUSED(p);
|
|
|
|
FuriMessageQueue* event_queue = furi_message_queue_alloc(8, sizeof(InputEvent));
|
|
furi_check(event_queue);
|
|
|
|
if(furi_hal_infrared_is_busy()) {
|
|
FURI_LOG_E(TAG, "Infrared is busy.");
|
|
return -1;
|
|
}
|
|
|
|
IRScopeState state = {
|
|
.autoscale = false, .us_per_sample = 200, .timings = NULL, .timings_cnt = 0, .mutex = NULL};
|
|
state.mutex = furi_mutex_alloc(FuriMutexTypeNormal);
|
|
if(!state.mutex) {
|
|
FURI_LOG_E(TAG, "Cannot create mutex.");
|
|
return -1;
|
|
}
|
|
|
|
ViewPort* view_port = view_port_alloc();
|
|
view_port_draw_callback_set(view_port, render_callback, &state);
|
|
view_port_input_callback_set(view_port, input_callback, event_queue);
|
|
|
|
Gui* gui = furi_record_open("gui");
|
|
gui_add_view_port(gui, view_port, GuiLayerFullscreen);
|
|
|
|
InfraredWorker* worker = infrared_worker_alloc();
|
|
infrared_worker_rx_enable_signal_decoding(worker, false);
|
|
infrared_worker_rx_enable_blink_on_receiving(worker, true);
|
|
infrared_worker_rx_set_received_signal_callback(worker, ir_received_callback, &state);
|
|
infrared_worker_rx_start(worker);
|
|
|
|
InputEvent event;
|
|
bool processing = true;
|
|
while(processing &&
|
|
furi_message_queue_get(event_queue, &event, FuriWaitForever) == FuriStatusOk) {
|
|
if(event.type == InputTypeRelease) {
|
|
furi_mutex_acquire(state.mutex, FuriWaitForever);
|
|
|
|
if(event.key == InputKeyBack) {
|
|
processing = false;
|
|
} else if(event.key == InputKeyUp) {
|
|
state.us_per_sample = MIN(1000, state.us_per_sample + 25);
|
|
state.autoscale = false;
|
|
} else if(event.key == InputKeyDown) {
|
|
state.us_per_sample = MAX(25, state.us_per_sample - 25);
|
|
state.autoscale = false;
|
|
} else if(event.key == InputKeyOk) {
|
|
state.autoscale = !state.autoscale;
|
|
if(state.autoscale)
|
|
state_set_autoscale(&state);
|
|
else
|
|
state.us_per_sample = 200;
|
|
}
|
|
|
|
view_port_update(view_port);
|
|
furi_mutex_release(state.mutex);
|
|
}
|
|
}
|
|
|
|
// Clean up.
|
|
infrared_worker_rx_stop(worker);
|
|
infrared_worker_free(worker);
|
|
|
|
if(state.timings) free(state.timings);
|
|
|
|
view_port_enabled_set(view_port, false);
|
|
gui_remove_view_port(gui, view_port);
|
|
furi_record_close("gui");
|
|
view_port_free(view_port);
|
|
furi_message_queue_free(event_queue);
|
|
furi_mutex_free(state.mutex);
|
|
|
|
return 0;
|
|
}
|