274 lines
9.2 KiB
C
274 lines
9.2 KiB
C
|
#include "subghz_read_raw.h"
|
||
|
#include "../subghz_i.h"
|
||
|
|
||
|
#include <math.h>
|
||
|
#include <furi.h>
|
||
|
#include <furi-hal.h>
|
||
|
#include <input/input.h>
|
||
|
#include <gui/elements.h>
|
||
|
#include <lib/subghz/protocols/subghz_protocol_princeton.h>
|
||
|
|
||
|
#include <assets_icons.h>
|
||
|
#define SUBGHZ_READ_RAW_RSSI_HISTORY_SIZE 100
|
||
|
|
||
|
typedef enum {
|
||
|
SubghzReadRAWStatusStart,
|
||
|
SubghzReadRAWStatusIDLE,
|
||
|
SubghzReadRAWStatusREC,
|
||
|
//SubghzReadRAWStatusShowName,
|
||
|
} SubghzReadRAWStatus;
|
||
|
|
||
|
struct SubghzReadRAW {
|
||
|
View* view;
|
||
|
SubghzReadRAWCallback callback;
|
||
|
void* context;
|
||
|
};
|
||
|
|
||
|
typedef struct {
|
||
|
string_t frequency_str;
|
||
|
string_t preset_str;
|
||
|
string_t sample_write;
|
||
|
uint8_t* rssi_history;
|
||
|
bool rssi_history_end;
|
||
|
uint8_t ind_write;
|
||
|
SubghzReadRAWStatus satus;
|
||
|
} SubghzReadRAWModel;
|
||
|
|
||
|
void subghz_read_raw_set_callback(
|
||
|
SubghzReadRAW* subghz_read_raw,
|
||
|
SubghzReadRAWCallback callback,
|
||
|
void* context) {
|
||
|
furi_assert(subghz_read_raw);
|
||
|
furi_assert(callback);
|
||
|
subghz_read_raw->callback = callback;
|
||
|
subghz_read_raw->context = context;
|
||
|
}
|
||
|
|
||
|
void subghz_read_raw_add_data_statusbar(
|
||
|
SubghzReadRAW* instance,
|
||
|
const char* frequency_str,
|
||
|
const char* preset_str) {
|
||
|
furi_assert(instance);
|
||
|
with_view_model(
|
||
|
instance->view, (SubghzReadRAWModel * model) {
|
||
|
string_set(model->frequency_str, frequency_str);
|
||
|
string_set(model->preset_str, preset_str);
|
||
|
return true;
|
||
|
});
|
||
|
}
|
||
|
|
||
|
void subghz_read_raw_add_data_rssi(SubghzReadRAW* instance, float rssi) {
|
||
|
furi_assert(instance);
|
||
|
uint8_t u_rssi = 0;
|
||
|
|
||
|
if(rssi < -90) {
|
||
|
u_rssi = 0;
|
||
|
} else {
|
||
|
u_rssi = (uint8_t)((rssi + 90) / 2.7);
|
||
|
}
|
||
|
//if(u_rssi > 34) u_rssi = 34;
|
||
|
|
||
|
with_view_model(
|
||
|
instance->view, (SubghzReadRAWModel * model) {
|
||
|
model->rssi_history[model->ind_write++] = u_rssi;
|
||
|
if(model->ind_write > SUBGHZ_READ_RAW_RSSI_HISTORY_SIZE) {
|
||
|
model->rssi_history_end = true;
|
||
|
model->ind_write = 0;
|
||
|
}
|
||
|
return true;
|
||
|
});
|
||
|
}
|
||
|
|
||
|
void subghz_read_raw_update_sample_write(SubghzReadRAW* instance, size_t sample) {
|
||
|
furi_assert(instance);
|
||
|
|
||
|
with_view_model(
|
||
|
instance->view, (SubghzReadRAWModel * model) {
|
||
|
string_printf(model->sample_write, "%d spl.", sample);
|
||
|
return false;
|
||
|
});
|
||
|
}
|
||
|
|
||
|
void subghz_read_raw_draw_rssi(Canvas* canvas, SubghzReadRAWModel* model) {
|
||
|
int ind = 0;
|
||
|
int base = 0;
|
||
|
if(model->rssi_history_end == false) {
|
||
|
for(int i = model->ind_write; i >= 0; i--) {
|
||
|
canvas_draw_line(canvas, i, 47, i, 47 - model->rssi_history[i]);
|
||
|
}
|
||
|
if(model->ind_write > 3) {
|
||
|
canvas_draw_line(canvas, model->ind_write, 47, model->ind_write, 13);
|
||
|
canvas_draw_line(canvas, model->ind_write - 2, 12, model->ind_write + 2, 12);
|
||
|
canvas_draw_line(canvas, model->ind_write - 1, 13, model->ind_write + 1, 13);
|
||
|
}
|
||
|
} else {
|
||
|
base = SUBGHZ_READ_RAW_RSSI_HISTORY_SIZE - model->ind_write;
|
||
|
for(int i = SUBGHZ_READ_RAW_RSSI_HISTORY_SIZE; i >= 0; i--) {
|
||
|
ind = i - base;
|
||
|
if(ind < 0) ind += SUBGHZ_READ_RAW_RSSI_HISTORY_SIZE;
|
||
|
canvas_draw_line(canvas, i, 47, i, 47 - model->rssi_history[ind]);
|
||
|
}
|
||
|
canvas_draw_line(
|
||
|
canvas, SUBGHZ_READ_RAW_RSSI_HISTORY_SIZE, 47, SUBGHZ_READ_RAW_RSSI_HISTORY_SIZE, 13);
|
||
|
canvas_draw_line(
|
||
|
canvas,
|
||
|
SUBGHZ_READ_RAW_RSSI_HISTORY_SIZE - 2,
|
||
|
12,
|
||
|
SUBGHZ_READ_RAW_RSSI_HISTORY_SIZE + 2,
|
||
|
12);
|
||
|
canvas_draw_line(
|
||
|
canvas,
|
||
|
SUBGHZ_READ_RAW_RSSI_HISTORY_SIZE - 1,
|
||
|
13,
|
||
|
SUBGHZ_READ_RAW_RSSI_HISTORY_SIZE + 1,
|
||
|
13);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void subghz_read_raw_draw(Canvas* canvas, SubghzReadRAWModel* model) {
|
||
|
canvas_set_color(canvas, ColorBlack);
|
||
|
canvas_set_font(canvas, FontSecondary);
|
||
|
canvas_draw_str(canvas, 5, 8, string_get_cstr(model->frequency_str));
|
||
|
canvas_draw_str(canvas, 40, 8, string_get_cstr(model->preset_str));
|
||
|
canvas_draw_str_aligned(
|
||
|
canvas, 126, 0, AlignRight, AlignTop, string_get_cstr(model->sample_write));
|
||
|
|
||
|
canvas_draw_line(canvas, 0, 14, 115, 14);
|
||
|
subghz_read_raw_draw_rssi(canvas, model);
|
||
|
canvas_draw_line(canvas, 0, 48, 115, 48);
|
||
|
canvas_draw_line(canvas, 115, 14, 115, 48);
|
||
|
|
||
|
if(model->satus == SubghzReadRAWStatusIDLE) {
|
||
|
elements_button_left(canvas, "Config");
|
||
|
elements_button_center(canvas, "REC");
|
||
|
elements_button_right(canvas, "More");
|
||
|
} else if(model->satus == SubghzReadRAWStatusStart) {
|
||
|
elements_button_left(canvas, "Config");
|
||
|
elements_button_center(canvas, "REC");
|
||
|
} else {
|
||
|
elements_button_center(canvas, "Stop");
|
||
|
}
|
||
|
|
||
|
canvas_set_font_direction(canvas, 3);
|
||
|
canvas_draw_str(canvas, 126, 40, "RSSI");
|
||
|
canvas_set_font_direction(canvas, 0);
|
||
|
}
|
||
|
|
||
|
bool subghz_read_raw_input(InputEvent* event, void* context) {
|
||
|
furi_assert(context);
|
||
|
SubghzReadRAW* instance = context;
|
||
|
|
||
|
if(event->key == InputKeyBack && event->type == InputTypeShort) {
|
||
|
instance->callback(SubghzCustomEventViewReadRAWBack, instance->context);
|
||
|
} else if(event->key == InputKeyLeft && event->type == InputTypeShort) {
|
||
|
with_view_model(
|
||
|
instance->view, (SubghzReadRAWModel * model) {
|
||
|
if(model->satus == SubghzReadRAWStatusIDLE ||
|
||
|
model->satus == SubghzReadRAWStatusStart) {
|
||
|
instance->callback(SubghzCustomEventViewReadRAWConfig, instance->context);
|
||
|
}
|
||
|
return true;
|
||
|
});
|
||
|
} else if(event->key == InputKeyRight && event->type == InputTypeShort) {
|
||
|
with_view_model(
|
||
|
instance->view, (SubghzReadRAWModel * model) {
|
||
|
if(model->satus == SubghzReadRAWStatusIDLE) {
|
||
|
instance->callback(SubghzCustomEventViewReadRAWMore, instance->context);
|
||
|
}
|
||
|
return true;
|
||
|
});
|
||
|
} else if(event->key == InputKeyOk && event->type == InputTypeShort) {
|
||
|
with_view_model(
|
||
|
instance->view, (SubghzReadRAWModel * model) {
|
||
|
if(model->satus == SubghzReadRAWStatusIDLE ||
|
||
|
model->satus == SubghzReadRAWStatusStart) {
|
||
|
instance->callback(SubghzCustomEventViewReadRAWREC, instance->context);
|
||
|
model->satus = SubghzReadRAWStatusREC;
|
||
|
model->ind_write = 0;
|
||
|
model->rssi_history_end = false;
|
||
|
} else {
|
||
|
instance->callback(SubghzCustomEventViewReadRAWIDLE, instance->context);
|
||
|
model->satus = SubghzReadRAWStatusIDLE;
|
||
|
}
|
||
|
return true;
|
||
|
});
|
||
|
}
|
||
|
|
||
|
return true;
|
||
|
}
|
||
|
|
||
|
void subghz_read_raw_enter(void* context) {
|
||
|
furi_assert(context);
|
||
|
SubghzReadRAW* instance = context;
|
||
|
|
||
|
with_view_model(
|
||
|
instance->view, (SubghzReadRAWModel * model) {
|
||
|
model->satus = SubghzReadRAWStatusStart;
|
||
|
model->rssi_history = furi_alloc(SUBGHZ_READ_RAW_RSSI_HISTORY_SIZE * sizeof(uint8_t));
|
||
|
model->rssi_history_end = false;
|
||
|
model->ind_write = 0;
|
||
|
string_set(model->sample_write, "0 spl.");
|
||
|
return true;
|
||
|
});
|
||
|
}
|
||
|
|
||
|
void subghz_read_raw_exit(void* context) {
|
||
|
furi_assert(context);
|
||
|
SubghzReadRAW* instance = context;
|
||
|
|
||
|
with_view_model(
|
||
|
instance->view, (SubghzReadRAWModel * model) {
|
||
|
if(model->satus != SubghzReadRAWStatusIDLE &&
|
||
|
model->satus != SubghzReadRAWStatusStart) {
|
||
|
instance->callback(SubghzCustomEventViewReadRAWIDLE, instance->context);
|
||
|
model->satus = SubghzReadRAWStatusStart;
|
||
|
}
|
||
|
string_clean(model->frequency_str);
|
||
|
string_clean(model->preset_str);
|
||
|
string_clean(model->sample_write);
|
||
|
free(model->rssi_history);
|
||
|
return true;
|
||
|
});
|
||
|
}
|
||
|
|
||
|
SubghzReadRAW* subghz_read_raw_alloc() {
|
||
|
SubghzReadRAW* instance = furi_alloc(sizeof(SubghzReadRAW));
|
||
|
|
||
|
// View allocation and configuration
|
||
|
instance->view = view_alloc();
|
||
|
view_allocate_model(instance->view, ViewModelTypeLocking, sizeof(SubghzReadRAWModel));
|
||
|
view_set_context(instance->view, instance);
|
||
|
view_set_draw_callback(instance->view, (ViewDrawCallback)subghz_read_raw_draw);
|
||
|
view_set_input_callback(instance->view, subghz_read_raw_input);
|
||
|
view_set_enter_callback(instance->view, subghz_read_raw_enter);
|
||
|
view_set_exit_callback(instance->view, subghz_read_raw_exit);
|
||
|
|
||
|
with_view_model(
|
||
|
instance->view, (SubghzReadRAWModel * model) {
|
||
|
string_init(model->frequency_str);
|
||
|
string_init(model->preset_str);
|
||
|
string_init(model->sample_write);
|
||
|
return true;
|
||
|
});
|
||
|
|
||
|
return instance;
|
||
|
}
|
||
|
|
||
|
void subghz_read_raw_free(SubghzReadRAW* instance) {
|
||
|
furi_assert(instance);
|
||
|
|
||
|
with_view_model(
|
||
|
instance->view, (SubghzReadRAWModel * model) {
|
||
|
string_clear(model->frequency_str);
|
||
|
string_clear(model->preset_str);
|
||
|
string_clear(model->sample_write);
|
||
|
return true;
|
||
|
});
|
||
|
view_free(instance->view);
|
||
|
free(instance);
|
||
|
}
|
||
|
|
||
|
View* subghz_read_raw_get_view(SubghzReadRAW* instance) {
|
||
|
furi_assert(instance);
|
||
|
return instance->view;
|
||
|
}
|