From 120a74ee1ad26af002304a4a8b94129b5714c469 Mon Sep 17 00:00:00 2001 From: MX <10697207+xMasterX@users.noreply.github.com> Date: Thu, 20 Oct 2022 21:02:27 +0300 Subject: [PATCH] add two new plugins --- .../plugins/flipper_i2ctools/README.md | 45 ++ .../plugins/flipper_i2ctools/application.fam | 12 + .../plugins/flipper_i2ctools/i2ctools.c | 650 +++++++++++++++++ .../plugins/flipper_i2ctools/i2ctools.png | Bin 0 -> 8425 bytes applications/plugins/gps_nmea_uart/.gitignore | 52 ++ applications/plugins/gps_nmea_uart/LICENSE | 674 ++++++++++++++++++ applications/plugins/gps_nmea_uart/README.md | 21 + .../plugins/gps_nmea_uart/application.fam | 12 + applications/plugins/gps_nmea_uart/gps.c | 121 ++++ .../plugins/gps_nmea_uart/gps_10px.png | Bin 0 -> 6750 bytes applications/plugins/gps_nmea_uart/gps_uart.c | 155 ++++ applications/plugins/gps_nmea_uart/gps_uart.h | 30 + applications/plugins/gps_nmea_uart/minmea.c | 640 +++++++++++++++++ applications/plugins/gps_nmea_uart/minmea.h | 295 ++++++++ .../plugins/heap_defence_game/hede_assets.c | 27 +- 15 files changed, 2729 insertions(+), 5 deletions(-) create mode 100644 applications/plugins/flipper_i2ctools/README.md create mode 100644 applications/plugins/flipper_i2ctools/application.fam create mode 100644 applications/plugins/flipper_i2ctools/i2ctools.c create mode 100644 applications/plugins/flipper_i2ctools/i2ctools.png create mode 100644 applications/plugins/gps_nmea_uart/.gitignore create mode 100644 applications/plugins/gps_nmea_uart/LICENSE create mode 100644 applications/plugins/gps_nmea_uart/README.md create mode 100644 applications/plugins/gps_nmea_uart/application.fam create mode 100644 applications/plugins/gps_nmea_uart/gps.c create mode 100644 applications/plugins/gps_nmea_uart/gps_10px.png create mode 100644 applications/plugins/gps_nmea_uart/gps_uart.c create mode 100644 applications/plugins/gps_nmea_uart/gps_uart.h create mode 100644 applications/plugins/gps_nmea_uart/minmea.c create mode 100644 applications/plugins/gps_nmea_uart/minmea.h diff --git a/applications/plugins/flipper_i2ctools/README.md b/applications/plugins/flipper_i2ctools/README.md new file mode 100644 index 000000000..169534fde --- /dev/null +++ b/applications/plugins/flipper_i2ctools/README.md @@ -0,0 +1,45 @@ +# flipperzero-i2ctools + +[Original link](https://github.com/NaejEL/flipperzero-i2ctools) + +Set of i2c tools for Flipper Zero + +## Wiring + +C0 -> SCL + +C1 -> SDA + +GND -> GND + +>/!\ Target must use 3v3 logic levels. If you not sure use an i2c isolator like ISO1541 + +## Tools + +### Scanner + +Look for i2c peripherals adresses + +### Sniffer + +Spy i2c traffic + +### Sender + +Send command to i2c peripherals and read result + +### Player + +> Not implemented yet + +Send command from file + +## TODO + +- [ ] Read more than 2 bytes in sender mode +- [ ] Save records +- [ ] Play from files +- [ ] Kicad module +- [ ] Improve UI +- [ ] Refactor Menu Management Code +- [ ] Add Documentation diff --git a/applications/plugins/flipper_i2ctools/application.fam b/applications/plugins/flipper_i2ctools/application.fam new file mode 100644 index 000000000..470947b1e --- /dev/null +++ b/applications/plugins/flipper_i2ctools/application.fam @@ -0,0 +1,12 @@ +App( + appid="i2cTools", + name="[GPIO] i2c Tools", + apptype=FlipperAppType.EXTERNAL, + entry_point="i2ctools_app", + cdefines=["APP_I2CTOOLS"], + requires=["gui"], + stack_size=2 * 1024, + order=175, + fap_icon="i2ctools.png", + fap_category="GPIO", +) \ No newline at end of file diff --git a/applications/plugins/flipper_i2ctools/i2ctools.c b/applications/plugins/flipper_i2ctools/i2ctools.c new file mode 100644 index 000000000..ca91cd2d5 --- /dev/null +++ b/applications/plugins/flipper_i2ctools/i2ctools.c @@ -0,0 +1,650 @@ +#include +#include +#include +#include +#include +#include + +#define MAX_I2C_ADDR 0x7F + +#define APP_NAME "I2C Tools" + +#define SCAN_MENU_TEXT "Scan" +#define SCAN_MENU_X 75 +#define SCAN_MENU_Y 6 + +#define SNIFF_MENU_TEXT "Sniff" +#define SNIFF_MENU_X 75 +#define SNIFF_MENU_Y 20 + +#define SEND_MENU_TEXT "Send" +#define SEND_MENU_X 75 +#define SEND_MENU_Y 34 + +#define PLAY_MENU_TEXT "Play" +#define PLAY_MENU_X 75 +#define PLAY_MENU_Y 48 + +// Sniffer Pins +#define pinSCL &gpio_ext_pc0 +#define pinSDA &gpio_ext_pc1 + +// I2C BUS +#define I2C_BUS &furi_hal_i2c_handle_external + +typedef enum { + MAIN_VIEW, + SCAN_VIEW, + SNIFF_VIEW, + SEND_VIEW, + //PLAY_VIEW, + + /* Know menu Size*/ + MENU_SIZE +} i2cToolsMainMenu; + +// Bus Sniffer +typedef enum { I2C_BUS_IDLE, I2C_BUS_STARTED } i2cBusStates; + +#define MAX_FRAMES 32 + +typedef struct { + uint8_t data[MAX_FRAMES]; + bool ack[MAX_FRAMES]; + uint8_t bit_index; + uint8_t data_index; +} i2cFrame; + +typedef struct { + bool started; + bool first; + i2cBusStates state; + i2cFrame frames[MAX_FRAMES]; + uint8_t frame_index; + uint8_t menu_index; +} _sniffer; + +// Bus scanner +typedef struct { + uint8_t addresses[MAX_I2C_ADDR + 1]; + uint8_t found; + uint8_t menu_index; + bool scanned; +} _scanner; + +// Sender +typedef struct { + uint8_t address_idx; + uint8_t value; + uint8_t recv[2]; + bool must_send; + bool sended; + bool error; +} _sender; + +typedef struct { + ViewPort* view_port; + i2cToolsMainMenu current_menu; + NotificationApp* notifications; // Used to blink LED + uint8_t main_menu_index; + + _scanner scanner; + _sniffer sniffer; + _sender sender; +} i2cToolsData; + +void scan_i2c_bus(i2cToolsData* data) { + data->scanner.found = 0; + data->scanner.scanned = true; + furi_hal_i2c_acquire(I2C_BUS); + // scan + for(uint8_t addr = 0x01; addr < MAX_I2C_ADDR; addr++) { + // Check for peripherals + if(furi_hal_i2c_is_device_ready(I2C_BUS, addr, 2)) { + // skip even 8-bit addr + if(addr % 2 != 0) { + continue; + } + // convert addr to 7-bits + data->scanner.addresses[data->scanner.found] = addr >> 1; + data->scanner.found++; + } + } + furi_hal_i2c_release(I2C_BUS); +} + +void i2ctools_draw_main_menu(Canvas* canvas, i2cToolsData* data) { + canvas_clear(canvas); + canvas_set_color(canvas, ColorBlack); + canvas_draw_rframe(canvas, 0, 0, 128, 64, 3); + canvas_draw_icon(canvas, 2, 13, &I_passport_bad3_46x49); + canvas_set_font(canvas, FontPrimary); + canvas_draw_str_aligned(canvas, 3, 3, AlignLeft, AlignTop, APP_NAME); + + switch(data->main_menu_index) { + case 0: + canvas_set_color(canvas, ColorBlack); + canvas_draw_str_aligned( + canvas, SNIFF_MENU_X, SNIFF_MENU_Y, AlignLeft, AlignTop, SNIFF_MENU_TEXT); + canvas_draw_str_aligned( + canvas, SEND_MENU_X, SEND_MENU_Y, AlignLeft, AlignTop, SEND_MENU_TEXT); + /*canvas_draw_str_aligned( + canvas, PLAY_MENU_X, PLAY_MENU_Y, AlignLeft, AlignTop, PLAY_MENU_TEXT);*/ + + canvas_draw_rbox(canvas, 60, SCAN_MENU_Y - 2, 60, 13, 3); + canvas_set_color(canvas, ColorWhite); + canvas_draw_str_aligned( + canvas, SCAN_MENU_X, SCAN_MENU_Y, AlignLeft, AlignTop, SCAN_MENU_TEXT); + break; + + case 1: + canvas_set_color(canvas, ColorBlack); + canvas_draw_str_aligned( + canvas, SCAN_MENU_X, SCAN_MENU_Y, AlignLeft, AlignTop, SCAN_MENU_TEXT); + canvas_draw_str_aligned( + canvas, SEND_MENU_X, SEND_MENU_Y, AlignLeft, AlignTop, SEND_MENU_TEXT); + /*canvas_draw_str_aligned( + canvas, PLAY_MENU_X, PLAY_MENU_Y, AlignLeft, AlignTop, PLAY_MENU_TEXT);*/ + + canvas_draw_rbox(canvas, 60, SNIFF_MENU_Y - 2, 60, 13, 3); + canvas_set_color(canvas, ColorWhite); + canvas_draw_str_aligned( + canvas, SNIFF_MENU_X, SNIFF_MENU_Y, AlignLeft, AlignTop, SNIFF_MENU_TEXT); + break; + + case 2: + canvas_set_color(canvas, ColorBlack); + canvas_draw_str_aligned( + canvas, SCAN_MENU_X, SCAN_MENU_Y, AlignLeft, AlignTop, SCAN_MENU_TEXT); + canvas_draw_str_aligned( + canvas, SNIFF_MENU_X, SNIFF_MENU_Y, AlignLeft, AlignTop, SNIFF_MENU_TEXT); + /*canvas_draw_str_aligned( + canvas, PLAY_MENU_X, PLAY_MENU_Y, AlignLeft, AlignTop, PLAY_MENU_TEXT);*/ + + canvas_draw_rbox(canvas, 60, SEND_MENU_Y - 2, 60, 13, 3); + canvas_set_color(canvas, ColorWhite); + canvas_draw_str_aligned( + canvas, SEND_MENU_X, SEND_MENU_Y, AlignLeft, AlignTop, SEND_MENU_TEXT); + break; + + case 3: + canvas_set_color(canvas, ColorBlack); + canvas_draw_str_aligned( + canvas, SCAN_MENU_X, SCAN_MENU_Y, AlignLeft, AlignTop, SCAN_MENU_TEXT); + canvas_draw_str_aligned( + canvas, SNIFF_MENU_X, SNIFF_MENU_Y, AlignLeft, AlignTop, SNIFF_MENU_TEXT); + canvas_draw_str_aligned( + canvas, SEND_MENU_X, SEND_MENU_Y, AlignLeft, AlignTop, SEND_MENU_TEXT); + + canvas_draw_rbox(canvas, 60, PLAY_MENU_Y - 2, 60, 13, 3); + canvas_set_color(canvas, ColorWhite); + canvas_draw_str_aligned( + canvas, PLAY_MENU_X, PLAY_MENU_Y, AlignLeft, AlignTop, PLAY_MENU_TEXT); + break; + + default: + break; + } +} + +void clearSnifferBuffers(void* ctx) { + i2cToolsData* data = ctx; + for(uint8_t i = 0; i < MAX_FRAMES; i++) { + for(uint8_t j = 0; j < MAX_FRAMES; j++) { + data->sniffer.frames[i].ack[j] = false; + data->sniffer.frames[i].data[j] = 0; + } + data->sniffer.frames[i].bit_index = 0; + data->sniffer.frames[i].data_index = 0; + } + data->sniffer.frame_index = 0; + data->sniffer.state = I2C_BUS_IDLE; + data->sniffer.first = true; +} + +// Called on Fallin/Rising SDA +// Used to monitor i2c bus state +static void SDAcallback(void* ctx) { + i2cToolsData* data = ctx; + // SCL is low maybe cclock strecching + if(furi_hal_gpio_read(pinSCL) == false) { + return; + } + // Check for stop condition: SDA rising while SCL is High + if(data->sniffer.state == I2C_BUS_STARTED) { + if(furi_hal_gpio_read(pinSDA) == true) { + data->sniffer.state = I2C_BUS_IDLE; + view_port_update(data->view_port); + } + } + // Check for start condition: SDA falling while SCL is high + else if(furi_hal_gpio_read(pinSDA) == false) { + data->sniffer.state = I2C_BUS_STARTED; + if(data->sniffer.first) { + data->sniffer.first = false; + return; + } + data->sniffer.frame_index++; + if(data->sniffer.frame_index >= MAX_FRAMES) { + clearSnifferBuffers(ctx); + } + } + return; +} + +// Called on Rising SCL +// Used to read bus datas +static void SCLcallback(void* ctx) { + i2cToolsData* data = ctx; + if(data->sniffer.state == I2C_BUS_IDLE) { + return; + } + uint8_t frame = data->sniffer.frame_index; + uint8_t bit = data->sniffer.frames[frame].bit_index; + uint8_t data_idx = data->sniffer.frames[frame].data_index; + if(bit < 8) { + data->sniffer.frames[frame].data[data_idx] <<= 1; + data->sniffer.frames[frame].data[data_idx] |= (int)furi_hal_gpio_read(pinSDA); + data->sniffer.frames[frame].bit_index++; + } else { + data->sniffer.frames[frame].ack[data_idx] = !furi_hal_gpio_read(pinSDA); + data->sniffer.frames[frame].data_index++; + data->sniffer.frames[frame].bit_index = 0; + } +} + +void start_interrupts(i2cToolsData* data) { + furi_hal_gpio_init(pinSCL, GpioModeInterruptRise, GpioPullNo, GpioSpeedHigh); + furi_hal_gpio_add_int_callback(pinSCL, SCLcallback, data); + + // Add Rise and Fall Interrupt on SDA pin + furi_hal_gpio_init(pinSDA, GpioModeInterruptRiseFall, GpioPullNo, GpioSpeedHigh); + furi_hal_gpio_add_int_callback(pinSDA, SDAcallback, data); +} + +void stop_interrupts() { + furi_hal_gpio_remove_int_callback(pinSCL); + furi_hal_gpio_remove_int_callback(pinSDA); +} + +void i2ctools_draw_sniff_view(Canvas* canvas, i2cToolsData* data) { + canvas_clear(canvas); + canvas_set_color(canvas, ColorBlack); + canvas_draw_rframe(canvas, 0, 0, 128, 64, 3); + canvas_draw_icon(canvas, 2, 13, &I_passport_happy2_46x49); + + canvas_set_font(canvas, FontPrimary); + canvas_draw_str_aligned(canvas, 3, 3, AlignLeft, AlignTop, SNIFF_MENU_TEXT); + canvas_set_font(canvas, FontSecondary); + + // Button + canvas_draw_rbox(canvas, 70, 48, 45, 13, 3); + canvas_set_color(canvas, ColorWhite); + canvas_draw_icon(canvas, 75, 50, &I_Ok_btn_9x9); + if(!data->sniffer.started) { + canvas_draw_str_aligned(canvas, 85, 51, AlignLeft, AlignTop, "Start"); + } else { + canvas_draw_str_aligned(canvas, 85, 51, AlignLeft, AlignTop, "Stop"); + } + canvas_set_color(canvas, ColorBlack); + // Address text + char addr_text[8]; + snprintf( + addr_text, + sizeof(addr_text), + "0x%02x", + (int)(data->sniffer.frames[data->sniffer.menu_index].data[0] >> 1)); + canvas_draw_str_aligned(canvas, 50, 3, AlignLeft, AlignTop, "Addr: "); + canvas_draw_str_aligned(canvas, 75, 3, AlignLeft, AlignTop, addr_text); + // R/W + if((int)(data->sniffer.frames[data->sniffer.menu_index].data[0]) % 2 == 0) { + canvas_draw_str_aligned(canvas, 105, 3, AlignLeft, AlignTop, "W"); + } else { + canvas_draw_str_aligned(canvas, 105, 3, AlignLeft, AlignTop, "R"); + } + // nbFrame text + canvas_draw_str_aligned(canvas, 50, 13, AlignLeft, AlignTop, "Frames: "); + snprintf(addr_text, sizeof(addr_text), "%d", (int)data->sniffer.menu_index + 1); + canvas_draw_str_aligned(canvas, 90, 13, AlignLeft, AlignTop, addr_text); + canvas_draw_str_aligned(canvas, 100, 13, AlignLeft, AlignTop, "/"); + snprintf(addr_text, sizeof(addr_text), "%d", (int)data->sniffer.frame_index + 1); + canvas_draw_str_aligned(canvas, 110, 13, AlignLeft, AlignTop, addr_text); + // Frames content + uint8_t x_pos = 0; + uint8_t y_pos = 23; + for(uint8_t i = 1; i < data->sniffer.frames[data->sniffer.menu_index].data_index; i++) { + snprintf( + addr_text, + sizeof(addr_text), + "0x%02x", + (int)data->sniffer.frames[data->sniffer.menu_index].data[i]); + x_pos = 50 + (i - 1) * 35; + canvas_draw_str_aligned(canvas, x_pos, y_pos, AlignLeft, AlignTop, addr_text); + if(data->sniffer.frames[data->sniffer.menu_index].ack[i]) { + canvas_draw_str_aligned(canvas, x_pos + 24, y_pos, AlignLeft, AlignTop, "A"); + } else { + canvas_draw_str_aligned(canvas, x_pos + 24, y_pos, AlignLeft, AlignTop, "N"); + } + } +} + +void i2ctools_draw_record_view(Canvas* canvas, i2cToolsData* data) { + UNUSED(data); + canvas_clear(canvas); + canvas_set_color(canvas, ColorBlack); + canvas_draw_rframe(canvas, 0, 0, 128, 64, 3); + canvas_draw_icon(canvas, 2, 13, &I_passport_happy2_46x49); + + canvas_set_font(canvas, FontPrimary); + canvas_draw_str_aligned(canvas, 3, 3, AlignLeft, AlignTop, PLAY_MENU_TEXT); +} + +void i2ctools_draw_send_view(Canvas* canvas, i2cToolsData* data) { + canvas_clear(canvas); + canvas_set_color(canvas, ColorBlack); + canvas_draw_rframe(canvas, 0, 0, 128, 64, 3); + canvas_draw_icon(canvas, 2, 13, &I_passport_happy2_46x49); + canvas_set_font(canvas, FontPrimary); + canvas_draw_str_aligned(canvas, 3, 3, AlignLeft, AlignTop, SEND_MENU_TEXT); + + if(!data->scanner.scanned) { + scan_i2c_bus(data); + } + + canvas_set_font(canvas, FontSecondary); + if(data->scanner.found <= 0) { + canvas_draw_str_aligned(canvas, 60, 5, AlignLeft, AlignTop, "No peripherals"); + canvas_draw_str_aligned(canvas, 60, 15, AlignLeft, AlignTop, "Found"); + return; + } + canvas_draw_rbox(canvas, 70, 48, 45, 13, 3); + canvas_set_color(canvas, ColorWhite); + canvas_draw_icon(canvas, 75, 50, &I_Ok_btn_9x9); + canvas_draw_str_aligned(canvas, 85, 51, AlignLeft, AlignTop, "Send"); + canvas_set_color(canvas, ColorBlack); + canvas_draw_str_aligned(canvas, 50, 5, AlignLeft, AlignTop, "Addr: "); + canvas_draw_icon(canvas, 80, 5, &I_ButtonLeft_4x7); + canvas_draw_icon(canvas, 115, 5, &I_ButtonRight_4x7); + char addr_text[8]; + snprintf( + addr_text, + sizeof(addr_text), + "0x%02x", + (int)data->scanner.addresses[data->sender.address_idx]); + canvas_draw_str_aligned(canvas, 90, 5, AlignLeft, AlignTop, addr_text); + canvas_draw_str_aligned(canvas, 50, 15, AlignLeft, AlignTop, "Value: "); + + canvas_draw_icon(canvas, 80, 17, &I_ButtonUp_7x4); + canvas_draw_icon(canvas, 115, 17, &I_ButtonDown_7x4); + snprintf(addr_text, sizeof(addr_text), "0x%02x", (int)data->sender.value); + canvas_draw_str_aligned(canvas, 90, 15, AlignLeft, AlignTop, addr_text); + if(data->sender.must_send) { + furi_hal_i2c_acquire(&furi_hal_i2c_handle_external); + data->sender.error = furi_hal_i2c_trx( + &furi_hal_i2c_handle_external, + data->scanner.addresses[data->sender.address_idx] << 1, + &data->sender.value, + 1, + data->sender.recv, + sizeof(data->sender.recv), + 3); + furi_hal_i2c_release(&furi_hal_i2c_handle_external); + data->sender.must_send = false; + data->sender.sended = true; + } + canvas_draw_str_aligned(canvas, 50, 25, AlignLeft, AlignTop, "Result: "); + if(data->sender.sended) { + //if(data->sender.error) { + for(uint8_t i = 0; i < sizeof(data->sender.recv); i++) { + snprintf(addr_text, sizeof(addr_text), "0x%02x", (int)data->sender.recv[i]); + canvas_draw_str_aligned(canvas, 90, 25 + (i * 10), AlignLeft, AlignTop, addr_text); + } + /* + } else { + canvas_draw_str_aligned(canvas, 90, 25, AlignLeft, AlignTop, "Error"); + }*/ + } +} + +void i2ctools_draw_scan_view(Canvas* canvas, i2cToolsData* data) { + canvas_clear(canvas); + canvas_set_color(canvas, ColorBlack); + canvas_draw_rframe(canvas, 0, 0, 128, 64, 3); + canvas_draw_icon(canvas, 2, 13, &I_passport_happy3_46x49); + canvas_set_font(canvas, FontPrimary); + canvas_draw_str_aligned(canvas, 3, 3, AlignLeft, AlignTop, SCAN_MENU_TEXT); + + char count_text[46]; + char count_text_fmt[] = "Found: %d"; + canvas_set_font(canvas, FontSecondary); + snprintf(count_text, sizeof(count_text), count_text_fmt, (int)data->scanner.found); + canvas_draw_str_aligned(canvas, 50, 3, AlignLeft, AlignTop, count_text); + uint8_t x_pos = 0; + uint8_t y_pos = 0; + uint8_t idx_to_print = 0; + for(uint8_t i = 0; i < (int)data->scanner.found; i++) { + idx_to_print = i + data->scanner.menu_index * 3; + if(idx_to_print >= MAX_I2C_ADDR) { + break; + } + snprintf( + count_text, sizeof(count_text), "0x%02x ", (int)data->scanner.addresses[idx_to_print]); + if(i < 3) { + x_pos = 50 + (i * 26); + y_pos = 15; + } else if(i < 6) { + x_pos = 50 + ((i - 3) * 26); + y_pos = 25; + } else if(i < 9) { + x_pos = 50 + ((i - 6) * 26); + y_pos = 35; + } else if(i < 12) { + x_pos = 50 + ((i - 9) * 26); + y_pos = 45; + } else if(i < 15) { + x_pos = 50 + ((i - 12) * 26); + y_pos = 55; + } else { + break; + } + canvas_draw_str_aligned(canvas, x_pos, y_pos, AlignLeft, AlignTop, count_text); + } + // Right cursor + y_pos = 14 + data->scanner.menu_index; + canvas_draw_rbox(canvas, 125, y_pos, 3, 10, 1); + + // Button + canvas_draw_rbox(canvas, 70, 48, 45, 13, 3); + canvas_set_color(canvas, ColorWhite); + canvas_draw_icon(canvas, 75, 50, &I_Ok_btn_9x9); + canvas_draw_str_aligned(canvas, 85, 51, AlignLeft, AlignTop, "Scan"); +} + +void i2ctools_draw_callback(Canvas* canvas, void* ctx) { + i2cToolsData* i2c_addr = acquire_mutex((ValueMutex*)ctx, 25); + + switch(i2c_addr->current_menu) { + case MAIN_VIEW: + i2ctools_draw_main_menu(canvas, i2c_addr); + break; + + case SCAN_VIEW: + i2ctools_draw_scan_view(canvas, i2c_addr); + break; + + case SNIFF_VIEW: + i2ctools_draw_sniff_view(canvas, i2c_addr); + break; + case SEND_VIEW: + i2ctools_draw_send_view(canvas, i2c_addr); + break; + /*case PLAY_VIEW: + i2ctools_draw_record_view(canvas, i2c_addr); + break;*/ + default: + break; + } + release_mutex((ValueMutex*)ctx, i2c_addr); +} + +void i2ctools_input_callback(InputEvent* input_event, void* ctx) { + furi_assert(ctx); + FuriMessageQueue* event_queue = ctx; + furi_message_queue_put(event_queue, input_event, FuriWaitForever); +} + +int32_t i2ctools_app(void* p) { + UNUSED(p); + FuriMessageQueue* event_queue = furi_message_queue_alloc(8, sizeof(InputEvent)); + + i2cToolsData* i2caddrs = malloc(sizeof(i2cToolsData)); + ValueMutex i2caddrs_mutex; + if(!init_mutex(&i2caddrs_mutex, i2caddrs, sizeof(i2cToolsData))) { + FURI_LOG_E(APP_NAME, "cannot create mutex\r\n"); + free(i2caddrs); + return -1; + } + printf(APP_NAME); + printf("\r\n"); + // i2caddrs->notifications = furi_record_open(RECORD_NOTIFICATION); + + i2caddrs->view_port = view_port_alloc(); + view_port_draw_callback_set(i2caddrs->view_port, i2ctools_draw_callback, &i2caddrs_mutex); + view_port_input_callback_set(i2caddrs->view_port, i2ctools_input_callback, event_queue); + + // Register view port in GUI + Gui* gui = furi_record_open(RECORD_GUI); + gui_add_view_port(gui, i2caddrs->view_port, GuiLayerFullscreen); + + InputEvent event; + + clearSnifferBuffers(i2caddrs); + i2caddrs->sniffer.started = false; + i2caddrs->sniffer.menu_index = 0; + + i2caddrs->scanner.menu_index = 0; + i2caddrs->scanner.scanned = false; + + i2caddrs->sender.must_send = false; + i2caddrs->sender.sended = false; + while(furi_message_queue_get(event_queue, &event, FuriWaitForever) == FuriStatusOk) { + if(event.key == InputKeyBack && event.type == InputTypeRelease) { + if(i2caddrs->current_menu == MAIN_VIEW) { + break; + } else { + if(i2caddrs->current_menu == SNIFF_VIEW) { + stop_interrupts(); + i2caddrs->sniffer.started = false; + i2caddrs->sniffer.state = I2C_BUS_IDLE; + } + i2caddrs->current_menu = MAIN_VIEW; + } + } else if(event.key == InputKeyUp && event.type == InputTypeRelease) { + if(i2caddrs->current_menu == MAIN_VIEW) { + if(i2caddrs->main_menu_index > 0) { + i2caddrs->main_menu_index--; + } + } else if(i2caddrs->current_menu == SCAN_VIEW) { + if(i2caddrs->scanner.menu_index > 0) { + i2caddrs->scanner.menu_index--; + } + } else if(i2caddrs->current_menu == SEND_VIEW) { + if(i2caddrs->sender.value < 0xFF) { + i2caddrs->sender.value++; + i2caddrs->sender.sended = false; + } + } + } else if( + event.key == InputKeyUp && + (event.type == InputTypeLong || event.type == InputTypeRepeat)) { + if(i2caddrs->current_menu == SEND_VIEW) { + if(i2caddrs->sender.value < 0xF9) { + i2caddrs->sender.value += 5; + i2caddrs->sender.sended = false; + } + } + + } else if(event.key == InputKeyDown && event.type == InputTypeRelease) { + if(i2caddrs->current_menu == MAIN_VIEW) { + if(i2caddrs->main_menu_index < 2) { + i2caddrs->main_menu_index++; + } + } else if(i2caddrs->current_menu == SCAN_VIEW) { + if(i2caddrs->scanner.menu_index < ((int)i2caddrs->scanner.found / 3)) { + i2caddrs->scanner.menu_index++; + } + } else if(i2caddrs->current_menu == SEND_VIEW) { + if(i2caddrs->sender.value > 0x00) { + i2caddrs->sender.value--; + i2caddrs->sender.sended = false; + } + } + } else if(event.key == InputKeyDown && event.type == InputTypeLong) { + if(i2caddrs->current_menu == SEND_VIEW) { + if(i2caddrs->sender.value > 0x05) { + i2caddrs->sender.value -= 5; + i2caddrs->sender.sended = false; + } + } + + } else if(event.key == InputKeyOk && event.type == InputTypeRelease) { + if(i2caddrs->current_menu == MAIN_VIEW) { + if(i2caddrs->main_menu_index == 0) { + scan_i2c_bus(i2caddrs); + i2caddrs->current_menu = SCAN_VIEW; + } else if(i2caddrs->main_menu_index == 1) { + i2caddrs->current_menu = SNIFF_VIEW; + } else if(i2caddrs->main_menu_index == 2) { + i2caddrs->current_menu = SEND_VIEW; + } /*else if(i2caddrs->main_menu_index == 3) { + i2caddrs->current_menu = PLAY_VIEW; + }*/ + } else if(i2caddrs->current_menu == SCAN_VIEW) { + scan_i2c_bus(i2caddrs); + } else if(i2caddrs->current_menu == SEND_VIEW) { + i2caddrs->sender.must_send = true; + } else if(i2caddrs->current_menu == SNIFF_VIEW) { + if(i2caddrs->sniffer.started) { + stop_interrupts(); + i2caddrs->sniffer.started = false; + i2caddrs->sniffer.state = I2C_BUS_IDLE; + } else { + start_interrupts(i2caddrs); + i2caddrs->sniffer.started = true; + i2caddrs->sniffer.state = I2C_BUS_IDLE; + } + } + } else if(event.key == InputKeyRight && event.type == InputTypeRelease) { + if(i2caddrs->current_menu == SEND_VIEW) { + if(i2caddrs->sender.address_idx < (i2caddrs->scanner.found - 1)) { + i2caddrs->sender.address_idx++; + i2caddrs->sender.sended = false; + } + } else if(i2caddrs->current_menu == SNIFF_VIEW) { + if(i2caddrs->sniffer.menu_index < i2caddrs->sniffer.frame_index) { + i2caddrs->sniffer.menu_index++; + } + } + } else if(event.key == InputKeyLeft && event.type == InputTypeRelease) { + if(i2caddrs->current_menu == SEND_VIEW) { + if(i2caddrs->sender.address_idx > 0) { + i2caddrs->sender.address_idx--; + i2caddrs->sender.sended = false; + } + } else if(i2caddrs->current_menu == SNIFF_VIEW) { + if(i2caddrs->sniffer.menu_index > 0) { + i2caddrs->sniffer.menu_index--; + } + } + } + view_port_update(i2caddrs->view_port); + } + gui_remove_view_port(gui, i2caddrs->view_port); + view_port_free(i2caddrs->view_port); + furi_message_queue_free(event_queue); + free(i2caddrs); + //furi_record_close(RECORD_NOTIFICATION); + furi_record_close(RECORD_GUI); + + return 0; +} diff --git a/applications/plugins/flipper_i2ctools/i2ctools.png b/applications/plugins/flipper_i2ctools/i2ctools.png new file mode 100644 index 0000000000000000000000000000000000000000..ba8485be80897afde4360dfe73c7d92dc3f2fe53 GIT binary patch literal 8425 zcmeHLcUV)~vJbsTQ4o-(5mbtXRMI5$&_i#6h#`dpfrKPf8-jv>6ahsAq&GnXqzKYH zh)R>9AnFlOKtU8xKn2?iSkJxZzI)I2z5CDmPV!}E@3m%rGxJ+Bv-aLGw$`TNq6(q_ z06^T_%-Ej$zj7`r%*#FU+Pb~~03_7H99=o~#9$zk#h}uCDL_srlLDlK(5V1G$b(nz z?m^RNiH|omsUlCM$64=nyn`TJS-j?5$)JZZce0e<#VhUNz4luvpuXhOY)j_n$W08C z#pVDIUoc=|BEcIG{w_c>@y~nppJz90PG_r*Z za>^v%EJf1NKF$GYAhNM)JStEm)-tJop09>Kzn~=XNTT~Kzm4}kNk;+Q+b-?lq_VYo zdpCZm6xB({vd1I4e{)XoeW7|_hiqgo{02BEd1P{;!{YuaEbVIQZ z7>sqFerxTKRb;wvSCbZ068Pa$Na*?0tF@ispDU`wr!#f4daYmIo#gq%bLdh|B90{2 z5vKp@UZKCc{47(sn@E|`x9wq^I4q$O(x|eBC&6u0G;q87jnd*`MA^V8C#S80PKq~k zMIEafPEs5D8)$HA!8Ys*uj_}L_gvVA?01yjI}Ypij~@xNBi+9uqfjbPwp&JPQ1rLd z_w5YNg@=k^X|}dLYj!&KS?=Re^f^8;j?#+6J9=g}@XWnhe6Jd$U6C!Fy46@EyvKq6 zL})KRb;E;E!|1US2JL|&0Atq&2J*(?P8ABdhM_f;LuKp3#UQp3FCMsN5_u*v%5Cl4 zNjkpL)jQ(dUE?il?w|?iM6#eIdQ7|x*}r8&mz&TRqT;AghrD+td!%xWR>OFF-AL%{ zeM@^Q-(jhpZ@ZPyEYWSlqY;uyhQ~MKmBo__<8)bK&>N{0)QIt;SEaSgG^Ty4dJ?L7 zGmH{2GFNOW+hshj9F?-X&~PsHqus#?1)s8#51ife$_2W$vG> zEPCYARc3R^)0F@!og!+~Ck2;2*)dNzn#_56oeDX#t#ogItaNKm&9Lv9PB+kL>2yCk zRn3g3WNTmNQ?6pN)dc#z!JeS}B78gRaFt>u?mpr0K8)0zPXnyppsQ7Gr(ljz?bP+6 z#pwnMPv&KlCCpB^(q%@kKM8AxPe_rsHkjjVNUu2AOoPQt`xgU{gpR38EZ@7=>|XQodS#*+cI zDMe*wEQjba$RZ2!l;Bot8+uD27q8$SRXvFZ9Ue%%ec}1(=+@EE8eW$*3 zk8YQ_8mXP>L!WlRR*Gf8oZo&Sr_BB=4J8I0Sf0-h_a^&M}jX~(l9p!P}L z7b$M(A=k`7Th5hixZ4?Dw=oH%z2us%i933}D$Q5?z&_u0#@aneD2yWcc*Btiq+ISZ z_0JmpQSLKS;ma7sGDpa7@6L+_d4^?*6-&-ZEbR@~xx-T%Xdwjo0^MB30gz9wozzer zKjCpTquSRky^_BFZ9;-8sEYndQ5`r#OBhYvCYq~THwQh|SgYOypQ^#%+4cn7lPEnM zbPCT~F!SX3qq-dNPCV>i%JC}8y`=r9e2X|vR_HvVDNQT+7xfBTm}f-w>zN~eoZ6Z@m6C2 zjDCeUO{&XclQT%pu_DL8cC2jSZ&<+#YG#Rx zS;=l2l%`vQDb_bxNyXEIr(!iSG+X`w z+K7%J;fnLHWefg=$?a1i9qREoo6HM$RW}EDIp3*OZ*Q%M4N`uC_axf?cJF~qrZP%o z(?--I9sKFIo)cHiT-$GBE8fQhGQ(ZB%w|Rw)rTIL=dn__+A_AJ;#a_zD*37{S8u^R z>Pze>I4q;+=H}ByvziCzAMLpwd@!QcpcdgFci*qxe^Yt7R4uacok6md(87X8KQ(MN zXa`22{=c$bH_I$gStCfvO~+rH?REu6Q#u1r!BqRGD~C*U<63Y=@` z%$SGb`eVDo_CJ$x35+T)ZjY{=tzAm7o9xi+Q~E7?`XaL``IfCD58aTMRK<1<->;M4K$(lm9G9nYNO#@q|t;YWmr>49&}a|`Ek2L~*T-%vpA(jKz0&q#Yk|%%Sk)4cR%d zYE`u!@_#f4ex07vG^r)eMnLL10B=6#FDCoPhBt-aB2OWXi7I9{ER5*N<4o)|a)R~y zwKu0mY?;X^Ir)0N(2A^f@SVv(2ufZl`;uF=2!>Qy2ofI}k4s zBfp1K%V+UE9aXA(mb52NMPpIydhynXqoa@pMZ3F%-p}JSy+!!)DD6q7p()>^^?A3M zhF~!bc?nG3%{vY|`?juU@|PuCYu_W48@4a^q>I2IA%S$)Fl6aMz5AzKmo2ic4ze%% zI2U0JeQKW97Ff`n);V0(OLKPe@_G9lBe0Nc@xJdyHnHo2r)zS#)l&S{ss7Zg^wxvL z90iSjze2|=k8b8kw%KWjSKKaxMjudT(5#qx zapj#BNTIQYi7@5a^7K}fjSJcG@s4rlZVyt1H-HW`+FaA9GTbx&0wR3x1;p2vcy^-g z?UdRF&xd-uCi*Fpidpq6`Q;nl<-4PrU!T>UZWk4NItwM*mVY*~*5Hlr=SvmtMFa^k(4` zZLtjLG5N(w$W-s%=O&)XPTuDd5;{dR$!8wY8Aa*$#nlo=&PZRV)sT1uxm6sJG=#<1 z9kb2ruse360lK>vDhYlZ+qYEGyX{W17Ks_^>z$#Th@SdX9U#VMA|Yp8@%n@@q_pbU zT8ArED(7GXIsUVkhGzw}ru5%uRAQd{q$Kt{Idea9H@+Zuu)hkN6LF_9Mz-e4^6x4W zmu@zCPxrqgjm)Q}HE)_fU)0D?;F*<$x4yZCux$VhzL+SfF9p?K;uJ zjIX=68EVR5iLcpt?sAn^>qNxd{cI1Z7rLcT7j>40$j&U1|BE6l?KZy#t($((Kpv{*i<(HLa0yyS4>owd2%fzJ1l zLd}Oaly1yS{tR>GDjz1{gVm?Nq`^Fg0g)a(^wvd`>*pI9Q(N^E=P$kEYaA<%)$P47 zB91meSzOXHp?3m7hXAU3^qJmaG)-;ug?7>y7bK#{g0boJ!nj`Sg!W~0C*zlMn<;g zMn>Ns8MzON83#||%-Zyo+CAM1+}xC20-q-3U~7PyPm7(@4UgGwuYR$YH6@3jo7wMH z61W!;xhc*`NY2|sdAESU9N+c+4)cDz#Yazj+Pbl80eT~k_W$0*_pwLQq33*n{@@PP z6bsS%j~CV+zzcsm4wNwKzWdx5D&G4#P;!&!tdvgIhu^bQbJtr5zUP0st58w)wczW8 z!UFb)T0&J-{@N_*o8k??*Q)m@X^+uqN^j@8i%<4+OPj_VvzP1g=Eq1M4r}Wx=1;cteeim?DNmm%N7MHG@L{;tT}^*f{>lLMvzzpp zr7cbU{a&W6tw?6TqyBN+C`)KV*uYjJRz84mxKg+=s~9>|>)7gr%C0syS_qjR6&T?tlL62ni6NM?9Zv_kxt z+$VehKu0fxNhIx~aDZMEZ@NEDW%g=|3Xo35skmqpAOxlng+@0EV^JK!tQ|>V`$!nF zik_~hP6(C@;78#Qfgygr{%mXrPGuDr%ROHi2CD#9ML7F#Dy{@upb>*b0V1>zS`ZLE zgdPM_(G>;iu*g)by|KwR2<{b5g~s79v0!j;aIjV|T#Lc-2179z3>X3f!(bq;1c)8# z&mo3@{Mo825MMEjDQpsp&g9S;{=gMXq8B5OgHuuA&I7;u=f@-ve!%;)zp=pO0~|tR zf}vUvu%93JR}D4?AH)Uu=Fp#NupPNCLcsPEHY1QlqTqul{v6d`A;_d3`piIGO2LV-8kkGZPFCHoJOOd5m3VAB}PAL4&-@W=FOV86P= zp;Ldd{0E(tnST=J+Wm72-$`4==1LI=SYrk$a3wBtIMg&o{5pXmDO@hK;h+iOVSafbu6McX6Z3T+Vg`#?`7$spqXbKquqEHYh z5D|q$fRGRr1p`CEQ3!3)DioQ7r7~E4L~b_F{fOQaFw@_Abz)_`um-l~I2D){noN%Q3Q5-nL6;7c@q&6G|M?j$vBm{=g{wd^4VX?W1yn+dZXu)Bt zGe0>rV)!yx1O}OcQ-QBet*jfC8z+}};z|W@u~)~rVPcI~6e5RW%>8lUAlwRqU_el9 zN2oRyhQcCH+aYi){k1 zbUOt0D;(EJIyLm)Nv{+!P={-tn?YuDHiy9qT^;&b*$$L|uUB6$ed((u4Fs+hCzeS1 z8Zc=!O!BIyT(qx~^gqd-|9HuNps*QKPB4*0G4ST{i&HUJ>778^@6`u{!L_u3>MnGD zG9#F+@ka-OX_S>!{Fk(Y|AWZb#30H)#6_YJ{kW{BQA+QC=7X6hQ(}FeC&B zjY5z?M3OcI1oOgZ!=Yq2l1luVdH+x1)uxisL^25t(xyVZKnNI&TiggT5#&XIK@kWF z2}UG;Et-E7uPL|Tu4X+@eYJM~^^!s%++zC2)c>}mI^dOE=zH$!fd4tWb$%A~_ts>< z?Q|>Y&;BL-4T;`=OcGr#)N1o065(WSJ0*fpNHiRTfpMD`dL?EOnF=GrP*4(ziu~$^ zFZ~rb>u1IG<_ zNPEMNeEIT)RCN}(107R%{1}f2_l6pl%`1!0t@6*1Vj@+oCtS620?t;r#msHsg96h0 Z0T;8;4?1_g>E^-!%< + Everyone is permitted to copy and distribute verbatim copies + of this license document, but changing it is not allowed. + + Preamble + + The GNU General Public License is a free, copyleft license for +software and other kinds of works. + + The licenses for most software and other practical works are designed +to take away your freedom to share and change the works. By contrast, +the GNU General Public License is intended to guarantee your freedom to +share and change all versions of a program--to make sure it remains free +software for all its users. We, the Free Software Foundation, use the +GNU General Public License for most of our software; it applies also to +any other work released this way by its authors. You can apply it to +your programs, too. + + When we speak of free software, we are referring to freedom, not +price. Our General Public Licenses are designed to make sure that you +have the freedom to distribute copies of free software (and charge for +them if you wish), that you receive source code or can get it if you +want it, that you can change the software or use pieces of it in new +free programs, and that you know you can do these things. + + To protect your rights, we need to prevent others from denying you +these rights or asking you to surrender the rights. Therefore, you have +certain responsibilities if you distribute copies of the software, or if +you modify it: responsibilities to respect the freedom of others. + + For example, if you distribute copies of such a program, whether +gratis or for a fee, you must pass on to the recipients the same +freedoms that you received. You must make sure that they, too, receive +or can get the source code. And you must show them these terms so they +know their rights. + + Developers that use the GNU GPL protect your rights with two steps: +(1) assert copyright on the software, and (2) offer you this License +giving you legal permission to copy, distribute and/or modify it. + + For the developers' and authors' protection, the GPL clearly explains +that there is no warranty for this free software. For both users' and +authors' sake, the GPL requires that modified versions be marked as +changed, so that their problems will not be attributed erroneously to +authors of previous versions. + + Some devices are designed to deny users access to install or run +modified versions of the software inside them, although the manufacturer +can do so. This is fundamentally incompatible with the aim of +protecting users' freedom to change the software. The systematic +pattern of such abuse occurs in the area of products for individuals to +use, which is precisely where it is most unacceptable. Therefore, we +have designed this version of the GPL to prohibit the practice for those +products. If such problems arise substantially in other domains, we +stand ready to extend this provision to those domains in future versions +of the GPL, as needed to protect the freedom of users. + + Finally, every program is threatened constantly by software patents. +States should not allow patents to restrict development and use of +software on general-purpose computers, but in those that do, we wish to +avoid the special danger that patents applied to a free program could +make it effectively proprietary. To prevent this, the GPL assures that +patents cannot be used to render the program non-free. + + The precise terms and conditions for copying, distribution and +modification follow. + + TERMS AND CONDITIONS + + 0. Definitions. + + "This License" refers to version 3 of the GNU General Public License. + + "Copyright" also means copyright-like laws that apply to other kinds of +works, such as semiconductor masks. + + "The Program" refers to any copyrightable work licensed under this +License. Each licensee is addressed as "you". "Licensees" and +"recipients" may be individuals or organizations. + + To "modify" a work means to copy from or adapt all or part of the work +in a fashion requiring copyright permission, other than the making of an +exact copy. The resulting work is called a "modified version" of the +earlier work or a work "based on" the earlier work. + + A "covered work" means either the unmodified Program or a work based +on the Program. + + To "propagate" a work means to do anything with it that, without +permission, would make you directly or secondarily liable for +infringement under applicable copyright law, except executing it on a +computer or modifying a private copy. Propagation includes copying, +distribution (with or without modification), making available to the +public, and in some countries other activities as well. + + To "convey" a work means any kind of propagation that enables other +parties to make or receive copies. Mere interaction with a user through +a computer network, with no transfer of a copy, is not conveying. + + An interactive user interface displays "Appropriate Legal Notices" +to the extent that it includes a convenient and prominently visible +feature that (1) displays an appropriate copyright notice, and (2) +tells the user that there is no warranty for the work (except to the +extent that warranties are provided), that licensees may convey the +work under this License, and how to view a copy of this License. If +the interface presents a list of user commands or options, such as a +menu, a prominent item in the list meets this criterion. + + 1. Source Code. + + The "source code" for a work means the preferred form of the work +for making modifications to it. "Object code" means any non-source +form of a work. + + A "Standard Interface" means an interface that either is an official +standard defined by a recognized standards body, or, in the case of +interfaces specified for a particular programming language, one that +is widely used among developers working in that language. + + The "System Libraries" of an executable work include anything, other +than the work as a whole, that (a) is included in the normal form of +packaging a Major Component, but which is not part of that Major +Component, and (b) serves only to enable use of the work with that +Major Component, or to implement a Standard Interface for which an +implementation is available to the public in source code form. A +"Major Component", in this context, means a major essential component +(kernel, window system, and so on) of the specific operating system +(if any) on which the executable work runs, or a compiler used to +produce the work, or an object code interpreter used to run it. + + The "Corresponding Source" for a work in object code form means all +the source code needed to generate, install, and (for an executable +work) run the object code and to modify the work, including scripts to +control those activities. However, it does not include the work's +System Libraries, or general-purpose tools or generally available free +programs which are used unmodified in performing those activities but +which are not part of the work. For example, Corresponding Source +includes interface definition files associated with source files for +the work, and the source code for shared libraries and dynamically +linked subprograms that the work is specifically designed to require, +such as by intimate data communication or control flow between those +subprograms and other parts of the work. + + The Corresponding Source need not include anything that users +can regenerate automatically from other parts of the Corresponding +Source. + + The Corresponding Source for a work in source code form is that +same work. + + 2. Basic Permissions. + + All rights granted under this License are granted for the term of +copyright on the Program, and are irrevocable provided the stated +conditions are met. This License explicitly affirms your unlimited +permission to run the unmodified Program. The output from running a +covered work is covered by this License only if the output, given its +content, constitutes a covered work. This License acknowledges your +rights of fair use or other equivalent, as provided by copyright law. + + You may make, run and propagate covered works that you do not +convey, without conditions so long as your license otherwise remains +in force. You may convey covered works to others for the sole purpose +of having them make modifications exclusively for you, or provide you +with facilities for running those works, provided that you comply with +the terms of this License in conveying all material for which you do +not control copyright. Those thus making or running the covered works +for you must do so exclusively on your behalf, under your direction +and control, on terms that prohibit them from making any copies of +your copyrighted material outside their relationship with you. + + Conveying under any other circumstances is permitted solely under +the conditions stated below. Sublicensing is not allowed; section 10 +makes it unnecessary. + + 3. Protecting Users' Legal Rights From Anti-Circumvention Law. + + No covered work shall be deemed part of an effective technological +measure under any applicable law fulfilling obligations under article +11 of the WIPO copyright treaty adopted on 20 December 1996, or +similar laws prohibiting or restricting circumvention of such +measures. + + When you convey a covered work, you waive any legal power to forbid +circumvention of technological measures to the extent such circumvention +is effected by exercising rights under this License with respect to +the covered work, and you disclaim any intention to limit operation or +modification of the work as a means of enforcing, against the work's +users, your or third parties' legal rights to forbid circumvention of +technological measures. + + 4. Conveying Verbatim Copies. + + You may convey verbatim copies of the Program's source code as you +receive it, in any medium, provided that you conspicuously and +appropriately publish on each copy an appropriate copyright notice; +keep intact all notices stating that this License and any +non-permissive terms added in accord with section 7 apply to the code; +keep intact all notices of the absence of any warranty; and give all +recipients a copy of this License along with the Program. + + You may charge any price or no price for each copy that you convey, +and you may offer support or warranty protection for a fee. + + 5. Conveying Modified Source Versions. + + You may convey a work based on the Program, or the modifications to +produce it from the Program, in the form of source code under the +terms of section 4, provided that you also meet all of these conditions: + + a) The work must carry prominent notices stating that you modified + it, and giving a relevant date. + + b) The work must carry prominent notices stating that it is + released under this License and any conditions added under section + 7. This requirement modifies the requirement in section 4 to + "keep intact all notices". + + c) You must license the entire work, as a whole, under this + License to anyone who comes into possession of a copy. This + License will therefore apply, along with any applicable section 7 + additional terms, to the whole of the work, and all its parts, + regardless of how they are packaged. This License gives no + permission to license the work in any other way, but it does not + invalidate such permission if you have separately received it. + + d) If the work has interactive user interfaces, each must display + Appropriate Legal Notices; however, if the Program has interactive + interfaces that do not display Appropriate Legal Notices, your + work need not make them do so. + + A compilation of a covered work with other separate and independent +works, which are not by their nature extensions of the covered work, +and which are not combined with it such as to form a larger program, +in or on a volume of a storage or distribution medium, is called an +"aggregate" if the compilation and its resulting copyright are not +used to limit the access or legal rights of the compilation's users +beyond what the individual works permit. Inclusion of a covered work +in an aggregate does not cause this License to apply to the other +parts of the aggregate. + + 6. Conveying Non-Source Forms. + + You may convey a covered work in object code form under the terms +of sections 4 and 5, provided that you also convey the +machine-readable Corresponding Source under the terms of this License, +in one of these ways: + + a) Convey the object code in, or embodied in, a physical product + (including a physical distribution medium), accompanied by the + Corresponding Source fixed on a durable physical medium + customarily used for software interchange. + + b) Convey the object code in, or embodied in, a physical product + (including a physical distribution medium), accompanied by a + written offer, valid for at least three years and valid for as + long as you offer spare parts or customer support for that product + model, to give anyone who possesses the object code either (1) a + copy of the Corresponding Source for all the software in the + product that is covered by this License, on a durable physical + medium customarily used for software interchange, for a price no + more than your reasonable cost of physically performing this + conveying of source, or (2) access to copy the + Corresponding Source from a network server at no charge. + + c) Convey individual copies of the object code with a copy of the + written offer to provide the Corresponding Source. This + alternative is allowed only occasionally and noncommercially, and + only if you received the object code with such an offer, in accord + with subsection 6b. + + d) Convey the object code by offering access from a designated + place (gratis or for a charge), and offer equivalent access to the + Corresponding Source in the same way through the same place at no + further charge. You need not require recipients to copy the + Corresponding Source along with the object code. If the place to + copy the object code is a network server, the Corresponding Source + may be on a different server (operated by you or a third party) + that supports equivalent copying facilities, provided you maintain + clear directions next to the object code saying where to find the + Corresponding Source. Regardless of what server hosts the + Corresponding Source, you remain obligated to ensure that it is + available for as long as needed to satisfy these requirements. + + e) Convey the object code using peer-to-peer transmission, provided + you inform other peers where the object code and Corresponding + Source of the work are being offered to the general public at no + charge under subsection 6d. + + A separable portion of the object code, whose source code is excluded +from the Corresponding Source as a System Library, need not be +included in conveying the object code work. + + A "User Product" is either (1) a "consumer product", which means any +tangible personal property which is normally used for personal, family, +or household purposes, or (2) anything designed or sold for incorporation +into a dwelling. In determining whether a product is a consumer product, +doubtful cases shall be resolved in favor of coverage. For a particular +product received by a particular user, "normally used" refers to a +typical or common use of that class of product, regardless of the status +of the particular user or of the way in which the particular user +actually uses, or expects or is expected to use, the product. A product +is a consumer product regardless of whether the product has substantial +commercial, industrial or non-consumer uses, unless such uses represent +the only significant mode of use of the product. + + "Installation Information" for a User Product means any methods, +procedures, authorization keys, or other information required to install +and execute modified versions of a covered work in that User Product from +a modified version of its Corresponding Source. The information must +suffice to ensure that the continued functioning of the modified object +code is in no case prevented or interfered with solely because +modification has been made. + + If you convey an object code work under this section in, or with, or +specifically for use in, a User Product, and the conveying occurs as +part of a transaction in which the right of possession and use of the +User Product is transferred to the recipient in perpetuity or for a +fixed term (regardless of how the transaction is characterized), the +Corresponding Source conveyed under this section must be accompanied +by the Installation Information. But this requirement does not apply +if neither you nor any third party retains the ability to install +modified object code on the User Product (for example, the work has +been installed in ROM). + + The requirement to provide Installation Information does not include a +requirement to continue to provide support service, warranty, or updates +for a work that has been modified or installed by the recipient, or for +the User Product in which it has been modified or installed. Access to a +network may be denied when the modification itself materially and +adversely affects the operation of the network or violates the rules and +protocols for communication across the network. + + Corresponding Source conveyed, and Installation Information provided, +in accord with this section must be in a format that is publicly +documented (and with an implementation available to the public in +source code form), and must require no special password or key for +unpacking, reading or copying. + + 7. Additional Terms. + + "Additional permissions" are terms that supplement the terms of this +License by making exceptions from one or more of its conditions. +Additional permissions that are applicable to the entire Program shall +be treated as though they were included in this License, to the extent +that they are valid under applicable law. If additional permissions +apply only to part of the Program, that part may be used separately +under those permissions, but the entire Program remains governed by +this License without regard to the additional permissions. + + When you convey a copy of a covered work, you may at your option +remove any additional permissions from that copy, or from any part of +it. (Additional permissions may be written to require their own +removal in certain cases when you modify the work.) You may place +additional permissions on material, added by you to a covered work, +for which you have or can give appropriate copyright permission. + + Notwithstanding any other provision of this License, for material you +add to a covered work, you may (if authorized by the copyright holders of +that material) supplement the terms of this License with terms: + + a) Disclaiming warranty or limiting liability differently from the + terms of sections 15 and 16 of this License; or + + b) Requiring preservation of specified reasonable legal notices or + author attributions in that material or in the Appropriate Legal + Notices displayed by works containing it; or + + c) Prohibiting misrepresentation of the origin of that material, or + requiring that modified versions of such material be marked in + reasonable ways as different from the original version; or + + d) Limiting the use for publicity purposes of names of licensors or + authors of the material; or + + e) Declining to grant rights under trademark law for use of some + trade names, trademarks, or service marks; or + + f) Requiring indemnification of licensors and authors of that + material by anyone who conveys the material (or modified versions of + it) with contractual assumptions of liability to the recipient, for + any liability that these contractual assumptions directly impose on + those licensors and authors. + + All other non-permissive additional terms are considered "further +restrictions" within the meaning of section 10. If the Program as you +received it, or any part of it, contains a notice stating that it is +governed by this License along with a term that is a further +restriction, you may remove that term. If a license document contains +a further restriction but permits relicensing or conveying under this +License, you may add to a covered work material governed by the terms +of that license document, provided that the further restriction does +not survive such relicensing or conveying. + + If you add terms to a covered work in accord with this section, you +must place, in the relevant source files, a statement of the +additional terms that apply to those files, or a notice indicating +where to find the applicable terms. + + Additional terms, permissive or non-permissive, may be stated in the +form of a separately written license, or stated as exceptions; +the above requirements apply either way. + + 8. Termination. + + You may not propagate or modify a covered work except as expressly +provided under this License. Any attempt otherwise to propagate or +modify it is void, and will automatically terminate your rights under +this License (including any patent licenses granted under the third +paragraph of section 11). + + However, if you cease all violation of this License, then your +license from a particular copyright holder is reinstated (a) +provisionally, unless and until the copyright holder explicitly and +finally terminates your license, and (b) permanently, if the copyright +holder fails to notify you of the violation by some reasonable means +prior to 60 days after the cessation. + + Moreover, your license from a particular copyright holder is +reinstated permanently if the copyright holder notifies you of the +violation by some reasonable means, this is the first time you have +received notice of violation of this License (for any work) from that +copyright holder, and you cure the violation prior to 30 days after +your receipt of the notice. + + Termination of your rights under this section does not terminate the +licenses of parties who have received copies or rights from you under +this License. If your rights have been terminated and not permanently +reinstated, you do not qualify to receive new licenses for the same +material under section 10. + + 9. Acceptance Not Required for Having Copies. + + You are not required to accept this License in order to receive or +run a copy of the Program. Ancillary propagation of a covered work +occurring solely as a consequence of using peer-to-peer transmission +to receive a copy likewise does not require acceptance. However, +nothing other than this License grants you permission to propagate or +modify any covered work. These actions infringe copyright if you do +not accept this License. Therefore, by modifying or propagating a +covered work, you indicate your acceptance of this License to do so. + + 10. Automatic Licensing of Downstream Recipients. + + Each time you convey a covered work, the recipient automatically +receives a license from the original licensors, to run, modify and +propagate that work, subject to this License. You are not responsible +for enforcing compliance by third parties with this License. + + An "entity transaction" is a transaction transferring control of an +organization, or substantially all assets of one, or subdividing an +organization, or merging organizations. If propagation of a covered +work results from an entity transaction, each party to that +transaction who receives a copy of the work also receives whatever +licenses to the work the party's predecessor in interest had or could +give under the previous paragraph, plus a right to possession of the +Corresponding Source of the work from the predecessor in interest, if +the predecessor has it or can get it with reasonable efforts. + + You may not impose any further restrictions on the exercise of the +rights granted or affirmed under this License. For example, you may +not impose a license fee, royalty, or other charge for exercise of +rights granted under this License, and you may not initiate litigation +(including a cross-claim or counterclaim in a lawsuit) alleging that +any patent claim is infringed by making, using, selling, offering for +sale, or importing the Program or any portion of it. + + 11. Patents. + + A "contributor" is a copyright holder who authorizes use under this +License of the Program or a work on which the Program is based. The +work thus licensed is called the contributor's "contributor version". + + A contributor's "essential patent claims" are all patent claims +owned or controlled by the contributor, whether already acquired or +hereafter acquired, that would be infringed by some manner, permitted +by this License, of making, using, or selling its contributor version, +but do not include claims that would be infringed only as a +consequence of further modification of the contributor version. For +purposes of this definition, "control" includes the right to grant +patent sublicenses in a manner consistent with the requirements of +this License. + + Each contributor grants you a non-exclusive, worldwide, royalty-free +patent license under the contributor's essential patent claims, to +make, use, sell, offer for sale, import and otherwise run, modify and +propagate the contents of its contributor version. + + In the following three paragraphs, a "patent license" is any express +agreement or commitment, however denominated, not to enforce a patent +(such as an express permission to practice a patent or covenant not to +sue for patent infringement). To "grant" such a patent license to a +party means to make such an agreement or commitment not to enforce a +patent against the party. + + If you convey a covered work, knowingly relying on a patent license, +and the Corresponding Source of the work is not available for anyone +to copy, free of charge and under the terms of this License, through a +publicly available network server or other readily accessible means, +then you must either (1) cause the Corresponding Source to be so +available, or (2) arrange to deprive yourself of the benefit of the +patent license for this particular work, or (3) arrange, in a manner +consistent with the requirements of this License, to extend the patent +license to downstream recipients. "Knowingly relying" means you have +actual knowledge that, but for the patent license, your conveying the +covered work in a country, or your recipient's use of the covered work +in a country, would infringe one or more identifiable patents in that +country that you have reason to believe are valid. + + If, pursuant to or in connection with a single transaction or +arrangement, you convey, or propagate by procuring conveyance of, a +covered work, and grant a patent license to some of the parties +receiving the covered work authorizing them to use, propagate, modify +or convey a specific copy of the covered work, then the patent license +you grant is automatically extended to all recipients of the covered +work and works based on it. + + A patent license is "discriminatory" if it does not include within +the scope of its coverage, prohibits the exercise of, or is +conditioned on the non-exercise of one or more of the rights that are +specifically granted under this License. You may not convey a covered +work if you are a party to an arrangement with a third party that is +in the business of distributing software, under which you make payment +to the third party based on the extent of your activity of conveying +the work, and under which the third party grants, to any of the +parties who would receive the covered work from you, a discriminatory +patent license (a) in connection with copies of the covered work +conveyed by you (or copies made from those copies), or (b) primarily +for and in connection with specific products or compilations that +contain the covered work, unless you entered into that arrangement, +or that patent license was granted, prior to 28 March 2007. + + Nothing in this License shall be construed as excluding or limiting +any implied license or other defenses to infringement that may +otherwise be available to you under applicable patent law. + + 12. No Surrender of Others' Freedom. + + If conditions are imposed on you (whether by court order, agreement or +otherwise) that contradict the conditions of this License, they do not +excuse you from the conditions of this License. If you cannot convey a +covered work so as to satisfy simultaneously your obligations under this +License and any other pertinent obligations, then as a consequence you may +not convey it at all. For example, if you agree to terms that obligate you +to collect a royalty for further conveying from those to whom you convey +the Program, the only way you could satisfy both those terms and this +License would be to refrain entirely from conveying the Program. + + 13. Use with the GNU Affero General Public License. + + Notwithstanding any other provision of this License, you have +permission to link or combine any covered work with a work licensed +under version 3 of the GNU Affero General Public License into a single +combined work, and to convey the resulting work. The terms of this +License will continue to apply to the part which is the covered work, +but the special requirements of the GNU Affero General Public License, +section 13, concerning interaction through a network will apply to the +combination as such. + + 14. Revised Versions of this License. + + The Free Software Foundation may publish revised and/or new versions of +the GNU General Public License from time to time. Such new versions will +be similar in spirit to the present version, but may differ in detail to +address new problems or concerns. + + Each version is given a distinguishing version number. If the +Program specifies that a certain numbered version of the GNU General +Public License "or any later version" applies to it, you have the +option of following the terms and conditions either of that numbered +version or of any later version published by the Free Software +Foundation. If the Program does not specify a version number of the +GNU General Public License, you may choose any version ever published +by the Free Software Foundation. + + If the Program specifies that a proxy can decide which future +versions of the GNU General Public License can be used, that proxy's +public statement of acceptance of a version permanently authorizes you +to choose that version for the Program. + + Later license versions may give you additional or different +permissions. However, no additional obligations are imposed on any +author or copyright holder as a result of your choosing to follow a +later version. + + 15. Disclaimer of Warranty. + + THERE IS NO WARRANTY FOR THE PROGRAM, TO THE EXTENT PERMITTED BY +APPLICABLE LAW. EXCEPT WHEN OTHERWISE STATED IN WRITING THE COPYRIGHT +HOLDERS AND/OR OTHER PARTIES PROVIDE THE PROGRAM "AS IS" WITHOUT WARRANTY +OF ANY KIND, EITHER EXPRESSED OR IMPLIED, INCLUDING, BUT NOT LIMITED TO, +THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR +PURPOSE. THE ENTIRE RISK AS TO THE QUALITY AND PERFORMANCE OF THE PROGRAM +IS WITH YOU. SHOULD THE PROGRAM PROVE DEFECTIVE, YOU ASSUME THE COST OF +ALL NECESSARY SERVICING, REPAIR OR CORRECTION. + + 16. Limitation of Liability. + + IN NO EVENT UNLESS REQUIRED BY APPLICABLE LAW OR AGREED TO IN WRITING +WILL ANY COPYRIGHT HOLDER, OR ANY OTHER PARTY WHO MODIFIES AND/OR CONVEYS +THE PROGRAM AS PERMITTED ABOVE, BE LIABLE TO YOU FOR DAMAGES, INCLUDING ANY +GENERAL, SPECIAL, INCIDENTAL OR CONSEQUENTIAL DAMAGES ARISING OUT OF THE +USE OR INABILITY TO USE THE PROGRAM (INCLUDING BUT NOT LIMITED TO LOSS OF +DATA OR DATA BEING RENDERED INACCURATE OR LOSSES SUSTAINED BY YOU OR THIRD +PARTIES OR A FAILURE OF THE PROGRAM TO OPERATE WITH ANY OTHER PROGRAMS), +EVEN IF SUCH HOLDER OR OTHER PARTY HAS BEEN ADVISED OF THE POSSIBILITY OF +SUCH DAMAGES. + + 17. Interpretation of Sections 15 and 16. + + If the disclaimer of warranty and limitation of liability provided +above cannot be given local legal effect according to their terms, +reviewing courts shall apply local law that most closely approximates +an absolute waiver of all civil liability in connection with the +Program, unless a warranty or assumption of liability accompanies a +copy of the Program in return for a fee. + + END OF TERMS AND CONDITIONS + + How to Apply These Terms to Your New Programs + + If you develop a new program, and you want it to be of the greatest +possible use to the public, the best way to achieve this is to make it +free software which everyone can redistribute and change under these terms. + + To do so, attach the following notices to the program. It is safest +to attach them to the start of each source file to most effectively +state the exclusion of warranty; and each file should have at least +the "copyright" line and a pointer to where the full notice is found. + + + Copyright (C) + + This program is free software: you can redistribute it and/or modify + it under the terms of the GNU General Public License as published by + the Free Software Foundation, either version 3 of the License, or + (at your option) any later version. + + This program is distributed in the hope that it will be useful, + but WITHOUT ANY WARRANTY; without even the implied warranty of + MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + GNU General Public License for more details. + + You should have received a copy of the GNU General Public License + along with this program. If not, see . + +Also add information on how to contact you by electronic and paper mail. + + If the program does terminal interaction, make it output a short +notice like this when it starts in an interactive mode: + + Copyright (C) + This program comes with ABSOLUTELY NO WARRANTY; for details type `show w'. + This is free software, and you are welcome to redistribute it + under certain conditions; type `show c' for details. + +The hypothetical commands `show w' and `show c' should show the appropriate +parts of the General Public License. Of course, your program's commands +might be different; for a GUI interface, you would use an "about box". + + You should also get your employer (if you work as a programmer) or school, +if any, to sign a "copyright disclaimer" for the program, if necessary. +For more information on this, and how to apply and follow the GNU GPL, see +. + + The GNU General Public License does not permit incorporating your program +into proprietary programs. If your program is a subroutine library, you +may consider it more useful to permit linking proprietary applications with +the library. If this is what you want to do, use the GNU Lesser General +Public License instead of this License. But first, please read +. diff --git a/applications/plugins/gps_nmea_uart/README.md b/applications/plugins/gps_nmea_uart/README.md new file mode 100644 index 000000000..ae84b1f3b --- /dev/null +++ b/applications/plugins/gps_nmea_uart/README.md @@ -0,0 +1,21 @@ +# GPS for Flipper Zero + +[Original link](https://github.com/ezod/flipperzero-gps) + +A simple Flipper Zero application for NMEA 0183 serial GPS modules, such as the [Adafruit Ultimate GPS Breakout]. + +Heavy lifting (NMEA parsing) provided by [minmea], which is included in this repository. + +## Hardware Setup + +Connect the GPS module to power and the USART using GPIO pins 9 (3.3V), 11 (GND), 13 (TX), and 14 (RX), as appropriate. + +## Building the FAP + +1. Clone the [flipperzero-firmware] repository. +2. Create a symbolic link in `applications_user` named `gps`, pointing to this repository. +3. Compile with `./fbt fap_gps`. This will create the `gps.fap` binary. + +[Adafruit Ultimate GPS Breakout]: https://www.adafruit.com/product/746 +[minmea]: https://github.com/kosma/minmea +[flipperzero-firmware]: https://github.com/flipperdevices/flipperzero-firmware diff --git a/applications/plugins/gps_nmea_uart/application.fam b/applications/plugins/gps_nmea_uart/application.fam new file mode 100644 index 000000000..a5fdb4360 --- /dev/null +++ b/applications/plugins/gps_nmea_uart/application.fam @@ -0,0 +1,12 @@ +App( + appid="gps_nmea", + name="[NMEA] GPS", + apptype=FlipperAppType.EXTERNAL, + entry_point="gps_app", + cdefines=["APP_GPS"], + requires=["gui"], + stack_size=1 * 1024, + order=35, + fap_icon="gps_10px.png", + fap_category="GPIO", +) diff --git a/applications/plugins/gps_nmea_uart/gps.c b/applications/plugins/gps_nmea_uart/gps.c new file mode 100644 index 000000000..3536b3f1c --- /dev/null +++ b/applications/plugins/gps_nmea_uart/gps.c @@ -0,0 +1,121 @@ +#include "gps_uart.h" + +#include +#include +#include + +typedef enum { + EventTypeTick, + EventTypeKey, +} EventType; + +typedef struct { + EventType type; + InputEvent input; +} PluginEvent; + +static void render_callback(Canvas* const canvas, void* context) { + const GpsUart* gps_uart = acquire_mutex((ValueMutex*)context, 25); + if(gps_uart == NULL) { + return; + } + + canvas_set_font(canvas, FontSecondary); + char buffer[64]; + snprintf(buffer, 64, "LAT: %f", (double)gps_uart->status.latitude); + canvas_draw_str_aligned(canvas, 10, 10, AlignLeft, AlignBottom, buffer); + snprintf(buffer, 64, "LON: %f", (double)gps_uart->status.longitude); + canvas_draw_str_aligned(canvas, 10, 20, AlignLeft, AlignBottom, buffer); + snprintf( + buffer, + 64, + "C/S: %.1f / %.2fkn", + (double)gps_uart->status.course, + (double)gps_uart->status.speed); + canvas_draw_str_aligned(canvas, 10, 30, AlignLeft, AlignBottom, buffer); + snprintf( + buffer, + 64, + "ALT: %.1f %c", + (double)gps_uart->status.altitude, + gps_uart->status.altitude_units); + canvas_draw_str_aligned(canvas, 10, 40, AlignLeft, AlignBottom, buffer); + snprintf(buffer, 64, "FIX: %d", gps_uart->status.fix_quality); + canvas_draw_str_aligned(canvas, 10, 50, AlignLeft, AlignBottom, buffer); + snprintf(buffer, 64, "SAT: %d", gps_uart->status.satellites_tracked); + canvas_draw_str_aligned(canvas, 10, 60, AlignLeft, AlignBottom, buffer); + + release_mutex((ValueMutex*)context, gps_uart); +} + +static void input_callback(InputEvent* input_event, FuriMessageQueue* event_queue) { + furi_assert(event_queue); + + PluginEvent event = {.type = EventTypeKey, .input = *input_event}; + furi_message_queue_put(event_queue, &event, FuriWaitForever); +} + +int32_t gps_app(void* p) { + UNUSED(p); + + FuriMessageQueue* event_queue = furi_message_queue_alloc(8, sizeof(PluginEvent)); + + GpsUart* gps_uart = gps_uart_enable(); + + ValueMutex gps_uart_mutex; + if(!init_mutex(&gps_uart_mutex, gps_uart, sizeof(GpsUart))) { + FURI_LOG_E("GPS", "cannot create mutex\r\n"); + free(gps_uart); + return 255; + } + + // set system callbacks + ViewPort* view_port = view_port_alloc(); + view_port_draw_callback_set(view_port, render_callback, &gps_uart_mutex); + view_port_input_callback_set(view_port, input_callback, event_queue); + + // open GUI and register view_port + Gui* gui = furi_record_open("gui"); + gui_add_view_port(gui, view_port, GuiLayerFullscreen); + + PluginEvent event; + for(bool processing = true; processing;) { + FuriStatus event_status = furi_message_queue_get(event_queue, &event, 100); + + GpsUart* gps_uart = (GpsUart*)acquire_mutex_block(&gps_uart_mutex); + + if(event_status == FuriStatusOk) { + // press events + if(event.type == EventTypeKey) { + if(event.input.type == InputTypePress) { + switch(event.input.key) { + case InputKeyUp: + case InputKeyDown: + case InputKeyRight: + case InputKeyLeft: + case InputKeyOk: + break; + case InputKeyBack: + processing = false; + break; + } + } + } + } else { + FURI_LOG_D("GPS", "FuriMessageQueue: event timeout"); + } + + view_port_update(view_port); + release_mutex(&gps_uart_mutex, gps_uart); + } + + 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); + delete_mutex(&gps_uart_mutex); + gps_uart_disable(gps_uart); + + return 0; +} diff --git a/applications/plugins/gps_nmea_uart/gps_10px.png b/applications/plugins/gps_nmea_uart/gps_10px.png new file mode 100644 index 0000000000000000000000000000000000000000..841787a2a6131015634e906ff1cd4f189e0855aa GIT binary patch literal 6750 zcmeHKc{r5q_a9lZ6D`&nqa=*k#~Aw>N|wkjvoe;MF*6t>YsfwoWiOSKt%RtA>a`R~ zi9#VI6{3=Q72k(?dwZ|n_n-H=e&7F^>ze1epL3t{Ip=)tbKlo}4%_e9DIuyL3Ic&7 ztgXx)f%nQ-RCo>WTx0M01{lvoIJt5h31MI+i$SFYQox*WCIw94(x@O1cd*;dBS%%G z>Z|XD%L3BEtt@Ubo4Pjai)>u&P!-GhczJZy)0ex?p-jvt*Oe45jYJ<`l=40dX}s;o z>V7hw?SG+<>G(Cg?wkC9!Q#w;sl|sOVau`19na{{E^_wjwHZ#~_2 zY(8XxS7|-~o#XHLa_~U-Q^AAXcM_Kf6HZmAh#Q;p_qUfwO%9E?U#@7PR+O9-FZ)ne zHstt8e&+3oo2A;4r4-m_lDNvE*PJ%9kI&`A!Os~B!Wd~+Ha!3lh_vgcJ> zMS4#*z;e``XffA(D*jl%Q3O|TDW>-l&5k!ypI{I)e{1@QD7A?1iermU>(}Q`uS71y z)@iLboqd_HVG4r0NJvEZ7B@(wC4|J@Q5+pw9KXv=_sNo=i19>y7UfIWpO1<>SHnNI zY@567lNBxjN`_-@osez?xr*`3B)yZj3V_^(ce@%vqmrZoS8~CVBn& z2R2&gnVl9kJL+m}Fc2E6+u8qoU45diq9vVsbu6(TKmT~I?*RL_cf@p1OO&O8{`)Kk zOXZ*kX|i8P6FV+<;q!$KY0@0~D@rWN>jhmrdMj(WFSnIfTpcW|OYOINr{gNNDWEpD zM)75jLRHFeqHxZh$2fjM8H6t_)d7^GHr{nSOGcjEmRp@r<`c&YEa>)0i)}p<%RQtR zmLYk%ZP;jTVynTNWizEmK7@f>$i3oHVXJ9ILWP#xH=bYDn-r`63gyqx5;8~0Ya zYX)v0^Xle{kb604MMEzP=&7Gx?3n2kvD@G?>>I8y*yPKf5tVS3H`YuOw94Jep8?js zHCH>I9c!9S+Xhz(0e22)@azx0nUt{B+v@OGL(z8Rn)=xKKlpN7h{ts*RLh}_)y1tv zQ>8<$YU)Ch?IJ>5i`cZaLY5bp-*9lF*9pRt2W`mSg}#c(@$O&bBw+QX$-BAs-R;raxg(2>eEEW=5ZArjH#tLYx(NfaK#C`U?nD-Ik?j?W4T!(1V*6QOL zdVdY<&<$hHY@McIH*!U45ZCGHl#1&eZ>u|}^E30St2J-OJjmc|J{;q5mi+h(_r(#C_j)Nr$E+_>k;jnNM}j-$f2URbjnI8mx_GPM+< zo9L$Hiww>Wa)wW@zi7Js@EIp3;bL!GyNK@tGbUeCs;lvaVJWzqeavn)|Ktsdm#M=Q z({-OkQ>wyWiw2L#ftDYDBoo7hjtvcGs*B%Znt@>V1)D{adc01L=Q1nn5kxb5b&-SV zXnFG0w2CYb`AUTLDSFw2(%5z9MGUZJgdX#q#` zUIohboWk^_I3B)^5%rXRRBoD5m0LOLdZF;8WK3i_r~@ld3^M<$EX)V4>9-#I+ysht z8no3s-m%>$X}@0^R5 zw4;4hmpI!S!dYV<{5FbiX?q(we>?7))Q)9pK5Bew>(=2jVty*kma`eBKtgAq8QWuw zI&OPo5NHLH^(EmvaYz=sQYq@(y3v$3mdpCV*zPK6dHNo%W z(Q@?5Ou*v3c>R0vHCwc{Z1ky{)oPu_D1oBu6Ja@{-t1XJ!I{+COIX1f=wkD!mZpi( zDAC~n$!F(Unq-AW97dms#J^K#zDsBgTi+0Nb5u`sSdTEPEI2cQ>UE1-T-eRoIJ#sY zTX=f0iFLrcc`-^O5_l3cP|ky=-d`)J6y|HPbLwa>y6f4ikA*EQTWJ;n4H6e!f}l((xwh4!Sp}fp~=CjU+#PL<(-V>bIY4g zQI1lmc>HHQQozJAShhBO<`hH8-kgU%_r|QkzM((VWYKhcce94cf@)`neQf`@ac!-- zV9hoXmviaPhO)^nE7f5CiCT!$Qn66`rt*$mf^xJ(3Q|Yr?v*}F*`uW!*5@yIyP25O!jaDvRn( zNZs?=n`3$l@0!#w`1W1VL(7ssx;*%z4LZ-AUVM{8C+ZhZ#|32_)|5-oC1ljyJ+3>> zEkMO{1JEep&0_2+Be#91>`$lwy4?9`r4~wnUAI$knS?`@1SKj>D2vHi*Zt1+iiXT4O0Esw5;xvwW4hDpl{&vft~uI@`Q#wYKl+Hi zX+rzi3p(vPKQNZdI`X@N7Dfv)nj!Zkyhg*Y(lh${7h|;Q*6OHb75AnnUZkr=zEcT7 z7+`o3{WXlVi~=G(At%wm{&v~h&RnIY@sOdHcK%I7>C{0)hxUGx4)SJ3QFExY_SOz= zYHR3bdf#V(53gv$3m;(l?=}aYSduyuW^8vh^vX#TKOHfU_=nP1&?45zqkd6hbM+{* zxpn+e?>C`L7iPoA=-ivh&9f&WrRrU$rs#STr|S1VK0V#jO;((xi4UpmiObPTYg!id z>htMUNGV#h`LwjJ$?i(T8yz*?0ko_}L*=mlP!M~5-&4rB=^7Rqvd;ub_tW`!h^^!8*$;%6FG_ZsVnSox?l#$5{ z$j)LWCNx0{Q?Q@66=-}L%v@r5?raUJEKJd-O|Loi`lPvz>%L?4gF^c<{jWLH(x1{h2f4&8@m6HQF>>&xTPZR}wwc+c>rM8c~>|X?xFo_*nGeVAMz?*uLXLj>mvhP9dAfyNGSR zScbWN-&|R`#7pPtlq(u<@n}ALXF8s-=v4XU-I6DCE+N1)T}|JgT39ffGCLcgUCy<` z`IXK$%;qwyRV74?)Ss%qFModQ9-lL6va7A_Q2b5z3vub9*oPV0^v{&0dDQnwb#2nE z;+kE`?#w@H_$Z-UB$D1{CwMg(-idZVi@&cpqO!BNpk7@Y(J19I7xw2;S%Y|RB{78* zhtcAUWd0dH^5kk~Yb^2X1ia5E@>!$~da7li{#BH6__GB>pJD4+uTRw*d|sG+oUYl3 zPw2PBHERU4X?q5mw3GIQarR%xR<=?bn|8WE;~S)(q@6$E@w(_}fC+GuS!)PhS3MM4Zk!TKyR z74K+n`2zy@GJyDTI7~bY78Vw!9fs0ouzX<%U0q!m90@}rp@0UI9Zu&ExKKJR;jo|}*sm6B zjzuT{@*|-CYQc5_x;dC5h0O?Ikti0S6go%sR|qocr#&--6}XxXnFON*Qi1?gHsBTU z50^WwZS8+rtWe-f3u3NX0c8I}lS8BaP1ZkRTbWr+=hr|0^Pjl?(Ecm;Rb@cS))sHh zAcd@iXKii(S@Dl2Ge|TteszdI6H#ak3JoRdlBiHL0f~a*5Lg_POeLXF1R_e8L?-?M zWld*u2y_x<1quMyrU5uOA_Aw2#*v{!0ul{HQ*Z<*j*7%Wb+H&Uk&4xYlMvKjAnaH) zpehN0zecqJMFyadIyeGZ2abedbqR1N8biQ9aTF{HO2r}ofex93A?mC`kx6(<1}lgF zEGI39;7frq>AtHID}>`s?5zzTNNxDv68k^`hYA=NKz7sUA>6+woM=Imy&S>{n+Plx zjYFe!acDFO36S!)(mo1{4OHR^CIYUF`i{G@EO;OpfLOvxodN)>7CwjMqD;gWn2w$oAA2q+168!z^`xXeKtxkc#t7VHPkiI)%6GAEE zRY!o`_bHMef$mEI_VZ?@l_-8C(ev}oS;K1HSz@c!I6B3R`>Eh97 zC>)K4!y&LA3By))^v2~ulW5<*KfN16$AfD`FC~wrt4oZ@UN7ASJ(d=U7~+CJQO-`3kn0;nLR4E=s+tZ zMBKI0e6=Y8eKETh4U9yXR&Hz%Nb=UopRb)!Mh1jyIo7roYbQhnK-;xcg!t_Mk)gG@ ziId#JC_58L5LkFk|8n#0q#VtdI_7nTOM{9kWsWx^X#T`-*RCi#_I5rap210ZsbrQ~&?~ literal 0 HcmV?d00001 diff --git a/applications/plugins/gps_nmea_uart/gps_uart.c b/applications/plugins/gps_nmea_uart/gps_uart.c new file mode 100644 index 000000000..3a1152f28 --- /dev/null +++ b/applications/plugins/gps_nmea_uart/gps_uart.c @@ -0,0 +1,155 @@ +#include + +#include "minmea.h" +#include "gps_uart.h" + +typedef enum { + WorkerEvtStop = (1 << 0), + WorkerEvtRxDone = (1 << 1), +} WorkerEvtFlags; + +#define WORKER_ALL_RX_EVENTS (WorkerEvtStop | WorkerEvtRxDone) + +static void gps_uart_on_irq_cb(UartIrqEvent ev, uint8_t data, void* context) { + GpsUart* gps_uart = (GpsUart*)context; + + if(ev == UartIrqEventRXNE) { + furi_stream_buffer_send(gps_uart->rx_stream, &data, 1, 0); + furi_thread_flags_set(furi_thread_get_id(gps_uart->thread), WorkerEvtRxDone); + } +} + +static void gps_uart_serial_init(GpsUart* gps_uart) { + furi_hal_console_disable(); + furi_hal_uart_set_irq_cb(FuriHalUartIdUSART1, gps_uart_on_irq_cb, gps_uart); + furi_hal_uart_set_br(FuriHalUartIdUSART1, GPS_BAUDRATE); +} + +static void gps_uart_serial_deinit(GpsUart* gps_uart) { + UNUSED(gps_uart); + furi_hal_uart_set_irq_cb(FuriHalUartIdUSART1, NULL, NULL); + furi_hal_console_enable(); +} + +static void gps_uart_parse_nmea(GpsUart* gps_uart, char* line) { + switch(minmea_sentence_id(line, false)) { + case MINMEA_SENTENCE_RMC: { + struct minmea_sentence_rmc frame; + if(minmea_parse_rmc(&frame, line)) { + gps_uart->status.valid = frame.valid; + gps_uart->status.latitude = minmea_tocoord(&frame.latitude); + gps_uart->status.longitude = minmea_tocoord(&frame.longitude); + gps_uart->status.speed = minmea_tofloat(&frame.speed); + gps_uart->status.course = minmea_tofloat(&frame.course); + } + } break; + + case MINMEA_SENTENCE_GGA: { + struct minmea_sentence_gga frame; + if(minmea_parse_gga(&frame, line)) { + gps_uart->status.latitude = minmea_tocoord(&frame.latitude); + gps_uart->status.longitude = minmea_tocoord(&frame.longitude); + gps_uart->status.altitude = minmea_tofloat(&frame.altitude); + gps_uart->status.altitude_units = frame.altitude_units; + gps_uart->status.fix_quality = frame.fix_quality; + gps_uart->status.satellites_tracked = frame.satellites_tracked; + } + } break; + + default: + break; + } +} + +static int32_t gps_uart_worker(void* context) { + GpsUart* gps_uart = (GpsUart*)context; + + gps_uart->rx_stream = furi_stream_buffer_alloc(RX_BUF_SIZE * 5, 1); + size_t rx_offset = 0; + + gps_uart_serial_init(gps_uart); + + while(1) { + uint32_t events = + furi_thread_flags_wait(WORKER_ALL_RX_EVENTS, FuriFlagWaitAny, FuriWaitForever); + furi_check((events & FuriFlagError) == 0); + + if(events & WorkerEvtStop) { + break; + } + + if(events & WorkerEvtRxDone) { + size_t len = 0; + do { + len = furi_stream_buffer_receive( + gps_uart->rx_stream, + gps_uart->rx_buf + rx_offset, + RX_BUF_SIZE - 1 - rx_offset, + 0); + if(len > 0) { + rx_offset += len; + gps_uart->rx_buf[rx_offset] = '\0'; + + char* line_current = (char*)gps_uart->rx_buf; + while(1) { + while(*line_current == '\0' && + line_current < (char*)gps_uart->rx_buf + rx_offset - 1) { + line_current++; + } + + char* newline = strchr(line_current, '\n'); + if(newline) { + *newline = '\0'; + gps_uart_parse_nmea(gps_uart, line_current); + line_current = newline + 1; + } else { + if(line_current > (char*)gps_uart->rx_buf) { + rx_offset = 0; + while(*line_current) { + gps_uart->rx_buf[rx_offset++] = *(line_current++); + } + } + break; + } + } + } + } while(len > 0); + } + } + + gps_uart_serial_deinit(gps_uart); + furi_stream_buffer_free(gps_uart->rx_stream); + + return 0; +} + +GpsUart* gps_uart_enable() { + GpsUart* gps_uart = malloc(sizeof(GpsUart)); + + gps_uart->status.valid = false; + gps_uart->status.latitude = 0.0; + gps_uart->status.longitude = 0.0; + gps_uart->status.speed = 0.0; + gps_uart->status.course = 0.0; + gps_uart->status.altitude = 0.0; + gps_uart->status.altitude_units = ' '; + gps_uart->status.fix_quality = 0; + gps_uart->status.satellites_tracked = 0; + + gps_uart->thread = furi_thread_alloc(); + furi_thread_set_name(gps_uart->thread, "GpsUartWorker"); + furi_thread_set_stack_size(gps_uart->thread, 1024); + furi_thread_set_context(gps_uart->thread, gps_uart); + furi_thread_set_callback(gps_uart->thread, gps_uart_worker); + + furi_thread_start(gps_uart->thread); + return gps_uart; +} + +void gps_uart_disable(GpsUart* gps_uart) { + furi_assert(gps_uart); + furi_thread_flags_set(furi_thread_get_id(gps_uart->thread), WorkerEvtStop); + furi_thread_join(gps_uart->thread); + furi_thread_free(gps_uart->thread); + free(gps_uart); +} diff --git a/applications/plugins/gps_nmea_uart/gps_uart.h b/applications/plugins/gps_nmea_uart/gps_uart.h new file mode 100644 index 000000000..70a2db448 --- /dev/null +++ b/applications/plugins/gps_nmea_uart/gps_uart.h @@ -0,0 +1,30 @@ +#pragma once + +#include + +#define GPS_BAUDRATE 9600 +#define RX_BUF_SIZE 1024 + +typedef struct { + bool valid; + float latitude; + float longitude; + float speed; + float course; + float altitude; + char altitude_units; + int fix_quality; + int satellites_tracked; +} GpsStatus; + +typedef struct { + FuriThread* thread; + FuriStreamBuffer* rx_stream; + uint8_t rx_buf[RX_BUF_SIZE]; + + GpsStatus status; +} GpsUart; + +GpsUart* gps_uart_enable(); + +void gps_uart_disable(GpsUart* gps_uart); diff --git a/applications/plugins/gps_nmea_uart/minmea.c b/applications/plugins/gps_nmea_uart/minmea.c new file mode 100644 index 000000000..1b7a84b1c --- /dev/null +++ b/applications/plugins/gps_nmea_uart/minmea.c @@ -0,0 +1,640 @@ +/* + * Copyright © 2014 Kosma Moczek + * This program is free software. It comes without any warranty, to the extent + * permitted by applicable law. You can redistribute it and/or modify it under + * the terms of the Do What The Fuck You Want To Public License, Version 2, as + * published by Sam Hocevar. See the COPYING file for more details. + */ + +#include "minmea.h" + +#include +#include +#include + +#define boolstr(s) ((s) ? "true" : "false") + +static int hex2int(char c) { + if(c >= '0' && c <= '9') return c - '0'; + if(c >= 'A' && c <= 'F') return c - 'A' + 10; + if(c >= 'a' && c <= 'f') return c - 'a' + 10; + return -1; +} + +uint8_t minmea_checksum(const char* sentence) { + // Support senteces with or without the starting dollar sign. + if(*sentence == '$') sentence++; + + uint8_t checksum = 0x00; + + // The optional checksum is an XOR of all bytes between "$" and "*". + while(*sentence && *sentence != '*') checksum ^= *sentence++; + + return checksum; +} + +bool minmea_check(const char* sentence, bool strict) { + uint8_t checksum = 0x00; + + // A valid sentence starts with "$". + if(*sentence++ != '$') return false; + + // The optional checksum is an XOR of all bytes between "$" and "*". + while(*sentence && *sentence != '*' && isprint((unsigned char)*sentence)) + checksum ^= *sentence++; + + // If checksum is present... + if(*sentence == '*') { + // Extract checksum. + sentence++; + int upper = hex2int(*sentence++); + if(upper == -1) return false; + int lower = hex2int(*sentence++); + if(lower == -1) return false; + int expected = upper << 4 | lower; + + // Check for checksum mismatch. + if(checksum != expected) return false; + } else if(strict) { + // Discard non-checksummed frames in strict mode. + return false; + } + + // The only stuff allowed at this point is a newline. + while(*sentence == '\r' || *sentence == '\n') { + sentence++; + } + + if(*sentence) { + return false; + } + + return true; +} + +bool minmea_scan(const char* sentence, const char* format, ...) { + bool result = false; + bool optional = false; + + if(sentence == NULL) return false; + + va_list ap; + va_start(ap, format); + + const char* field = sentence; +#define next_field() \ + do { \ + /* Progress to the next field. */ \ + while(minmea_isfield(*sentence)) sentence++; \ + /* Make sure there is a field there. */ \ + if(*sentence == ',') { \ + sentence++; \ + field = sentence; \ + } else { \ + field = NULL; \ + } \ + } while(0) + + while(*format) { + char type = *format++; + + if(type == ';') { + // All further fields are optional. + optional = true; + continue; + } + + if(!field && !optional) { + // Field requested but we ran out if input. Bail out. + goto parse_error; + } + + switch(type) { + case 'c': { // Single character field (char). + char value = '\0'; + + if(field && minmea_isfield(*field)) value = *field; + + *va_arg(ap, char*) = value; + } break; + + case 'd': { // Single character direction field (int). + int value = 0; + + if(field && minmea_isfield(*field)) { + switch(*field) { + case 'N': + case 'E': + value = 1; + break; + case 'S': + case 'W': + value = -1; + break; + default: + goto parse_error; + } + } + + *va_arg(ap, int*) = value; + } break; + + case 'f': { // Fractional value with scale (struct minmea_float). + int sign = 0; + int_least32_t value = -1; + int_least32_t scale = 0; + + if(field) { + while(minmea_isfield(*field)) { + if(*field == '+' && !sign && value == -1) { + sign = 1; + } else if(*field == '-' && !sign && value == -1) { + sign = -1; + } else if(isdigit((unsigned char)*field)) { + int digit = *field - '0'; + if(value == -1) value = 0; + if(value > (INT_LEAST32_MAX - digit) / 10) { + /* we ran out of bits, what do we do? */ + if(scale) { + /* truncate extra precision */ + break; + } else { + /* integer overflow. bail out. */ + goto parse_error; + } + } + value = (10 * value) + digit; + if(scale) scale *= 10; + } else if(*field == '.' && scale == 0) { + scale = 1; + } else if(*field == ' ') { + /* Allow spaces at the start of the field. Not NMEA + * conformant, but some modules do this. */ + if(sign != 0 || value != -1 || scale != 0) goto parse_error; + } else { + goto parse_error; + } + field++; + } + } + + if((sign || scale) && value == -1) goto parse_error; + + if(value == -1) { + /* No digits were scanned. */ + value = 0; + scale = 0; + } else if(scale == 0) { + /* No decimal point. */ + scale = 1; + } + if(sign) value *= sign; + + *va_arg(ap, struct minmea_float*) = (struct minmea_float){value, scale}; + } break; + + case 'i': { // Integer value, default 0 (int). + int value = 0; + + if(field) { + char* endptr; + value = strtol(field, &endptr, 10); + if(minmea_isfield(*endptr)) goto parse_error; + } + + *va_arg(ap, int*) = value; + } break; + + case 's': { // String value (char *). + char* buf = va_arg(ap, char*); + + if(field) { + while(minmea_isfield(*field)) *buf++ = *field++; + } + + *buf = '\0'; + } break; + + case 't': { // NMEA talker+sentence identifier (char *). + // This field is always mandatory. + if(!field) goto parse_error; + + if(field[0] != '$') goto parse_error; + for(int f = 0; f < 5; f++) + if(!minmea_isfield(field[1 + f])) goto parse_error; + + char* buf = va_arg(ap, char*); + memcpy(buf, field + 1, 5); + buf[5] = '\0'; + } break; + + case 'D': { // Date (int, int, int), -1 if empty. + struct minmea_date* date = va_arg(ap, struct minmea_date*); + + int d = -1, m = -1, y = -1; + + if(field && minmea_isfield(*field)) { + // Always six digits. + for(int f = 0; f < 6; f++) + if(!isdigit((unsigned char)field[f])) goto parse_error; + + char dArr[] = {field[0], field[1], '\0'}; + char mArr[] = {field[2], field[3], '\0'}; + char yArr[] = {field[4], field[5], '\0'}; + d = strtol(dArr, NULL, 10); + m = strtol(mArr, NULL, 10); + y = strtol(yArr, NULL, 10); + } + + date->day = d; + date->month = m; + date->year = y; + } break; + + case 'T': { // Time (int, int, int, int), -1 if empty. + struct minmea_time* time_ = va_arg(ap, struct minmea_time*); + + int h = -1, i = -1, s = -1, u = -1; + + if(field && minmea_isfield(*field)) { + // Minimum required: integer time. + for(int f = 0; f < 6; f++) + if(!isdigit((unsigned char)field[f])) goto parse_error; + + char hArr[] = {field[0], field[1], '\0'}; + char iArr[] = {field[2], field[3], '\0'}; + char sArr[] = {field[4], field[5], '\0'}; + h = strtol(hArr, NULL, 10); + i = strtol(iArr, NULL, 10); + s = strtol(sArr, NULL, 10); + field += 6; + + // Extra: fractional time. Saved as microseconds. + if(*field++ == '.') { + uint32_t value = 0; + uint32_t scale = 1000000LU; + while(isdigit((unsigned char)*field) && scale > 1) { + value = (value * 10) + (*field++ - '0'); + scale /= 10; + } + u = value * scale; + } else { + u = 0; + } + } + + time_->hours = h; + time_->minutes = i; + time_->seconds = s; + time_->microseconds = u; + } break; + + case '_': { // Ignore the field. + } break; + + default: { // Unknown. + goto parse_error; + } + } + + next_field(); + } + + result = true; + +parse_error: + va_end(ap); + return result; +} + +bool minmea_talker_id(char talker[3], const char* sentence) { + char type[6]; + if(!minmea_scan(sentence, "t", type)) return false; + + talker[0] = type[0]; + talker[1] = type[1]; + talker[2] = '\0'; + + return true; +} + +enum minmea_sentence_id minmea_sentence_id(const char* sentence, bool strict) { + if(!minmea_check(sentence, strict)) return MINMEA_INVALID; + + char type[6]; + if(!minmea_scan(sentence, "t", type)) return MINMEA_INVALID; + + if(!strcmp(type + 2, "GBS")) return MINMEA_SENTENCE_GBS; + if(!strcmp(type + 2, "GGA")) return MINMEA_SENTENCE_GGA; + if(!strcmp(type + 2, "GLL")) return MINMEA_SENTENCE_GLL; + if(!strcmp(type + 2, "GSA")) return MINMEA_SENTENCE_GSA; + if(!strcmp(type + 2, "GST")) return MINMEA_SENTENCE_GST; + if(!strcmp(type + 2, "GSV")) return MINMEA_SENTENCE_GSV; + if(!strcmp(type + 2, "RMC")) return MINMEA_SENTENCE_RMC; + if(!strcmp(type + 2, "VTG")) return MINMEA_SENTENCE_VTG; + if(!strcmp(type + 2, "ZDA")) return MINMEA_SENTENCE_ZDA; + + return MINMEA_UNKNOWN; +} + +bool minmea_parse_gbs(struct minmea_sentence_gbs* frame, const char* sentence) { + // $GNGBS,170556.00,3.0,2.9,8.3,,,,*5C + char type[6]; + if(!minmea_scan( + sentence, + "tTfffifff", + type, + &frame->time, + &frame->err_latitude, + &frame->err_longitude, + &frame->err_altitude, + &frame->svid, + &frame->prob, + &frame->bias, + &frame->stddev)) + return false; + if(strcmp(type + 2, "GBS")) return false; + + return true; +} + +bool minmea_parse_rmc(struct minmea_sentence_rmc* frame, const char* sentence) { + // $GPRMC,081836,A,3751.65,S,14507.36,E,000.0,360.0,130998,011.3,E*62 + char type[6]; + char validity; + int latitude_direction; + int longitude_direction; + int variation_direction; + if(!minmea_scan( + sentence, + "tTcfdfdffDfd", + type, + &frame->time, + &validity, + &frame->latitude, + &latitude_direction, + &frame->longitude, + &longitude_direction, + &frame->speed, + &frame->course, + &frame->date, + &frame->variation, + &variation_direction)) + return false; + if(strcmp(type + 2, "RMC")) return false; + + frame->valid = (validity == 'A'); + frame->latitude.value *= latitude_direction; + frame->longitude.value *= longitude_direction; + frame->variation.value *= variation_direction; + + return true; +} + +bool minmea_parse_gga(struct minmea_sentence_gga* frame, const char* sentence) { + // $GPGGA,123519,4807.038,N,01131.000,E,1,08,0.9,545.4,M,46.9,M,,*47 + char type[6]; + int latitude_direction; + int longitude_direction; + + if(!minmea_scan( + sentence, + "tTfdfdiiffcfcf_", + type, + &frame->time, + &frame->latitude, + &latitude_direction, + &frame->longitude, + &longitude_direction, + &frame->fix_quality, + &frame->satellites_tracked, + &frame->hdop, + &frame->altitude, + &frame->altitude_units, + &frame->height, + &frame->height_units, + &frame->dgps_age)) + return false; + if(strcmp(type + 2, "GGA")) return false; + + frame->latitude.value *= latitude_direction; + frame->longitude.value *= longitude_direction; + + return true; +} + +bool minmea_parse_gsa(struct minmea_sentence_gsa* frame, const char* sentence) { + // $GPGSA,A,3,04,05,,09,12,,,24,,,,,2.5,1.3,2.1*39 + char type[6]; + + if(!minmea_scan( + sentence, + "tciiiiiiiiiiiiifff", + type, + &frame->mode, + &frame->fix_type, + &frame->sats[0], + &frame->sats[1], + &frame->sats[2], + &frame->sats[3], + &frame->sats[4], + &frame->sats[5], + &frame->sats[6], + &frame->sats[7], + &frame->sats[8], + &frame->sats[9], + &frame->sats[10], + &frame->sats[11], + &frame->pdop, + &frame->hdop, + &frame->vdop)) + return false; + if(strcmp(type + 2, "GSA")) return false; + + return true; +} + +bool minmea_parse_gll(struct minmea_sentence_gll* frame, const char* sentence) { + // $GPGLL,3723.2475,N,12158.3416,W,161229.487,A,A*41$; + char type[6]; + int latitude_direction; + int longitude_direction; + + if(!minmea_scan( + sentence, + "tfdfdTc;c", + type, + &frame->latitude, + &latitude_direction, + &frame->longitude, + &longitude_direction, + &frame->time, + &frame->status, + &frame->mode)) + return false; + if(strcmp(type + 2, "GLL")) return false; + + frame->latitude.value *= latitude_direction; + frame->longitude.value *= longitude_direction; + + return true; +} + +bool minmea_parse_gst(struct minmea_sentence_gst* frame, const char* sentence) { + // $GPGST,024603.00,3.2,6.6,4.7,47.3,5.8,5.6,22.0*58 + char type[6]; + + if(!minmea_scan( + sentence, + "tTfffffff", + type, + &frame->time, + &frame->rms_deviation, + &frame->semi_major_deviation, + &frame->semi_minor_deviation, + &frame->semi_major_orientation, + &frame->latitude_error_deviation, + &frame->longitude_error_deviation, + &frame->altitude_error_deviation)) + return false; + if(strcmp(type + 2, "GST")) return false; + + return true; +} + +bool minmea_parse_gsv(struct minmea_sentence_gsv* frame, const char* sentence) { + // $GPGSV,3,1,11,03,03,111,00,04,15,270,00,06,01,010,00,13,06,292,00*74 + // $GPGSV,3,3,11,22,42,067,42,24,14,311,43,27,05,244,00,,,,*4D + // $GPGSV,4,2,11,08,51,203,30,09,45,215,28*75 + // $GPGSV,4,4,13,39,31,170,27*40 + // $GPGSV,4,4,13*7B + char type[6]; + + if(!minmea_scan( + sentence, + "tiii;iiiiiiiiiiiiiiii", + type, + &frame->total_msgs, + &frame->msg_nr, + &frame->total_sats, + &frame->sats[0].nr, + &frame->sats[0].elevation, + &frame->sats[0].azimuth, + &frame->sats[0].snr, + &frame->sats[1].nr, + &frame->sats[1].elevation, + &frame->sats[1].azimuth, + &frame->sats[1].snr, + &frame->sats[2].nr, + &frame->sats[2].elevation, + &frame->sats[2].azimuth, + &frame->sats[2].snr, + &frame->sats[3].nr, + &frame->sats[3].elevation, + &frame->sats[3].azimuth, + &frame->sats[3].snr)) { + return false; + } + if(strcmp(type + 2, "GSV")) return false; + + return true; +} + +bool minmea_parse_vtg(struct minmea_sentence_vtg* frame, const char* sentence) { + // $GPVTG,054.7,T,034.4,M,005.5,N,010.2,K*48 + // $GPVTG,156.1,T,140.9,M,0.0,N,0.0,K*41 + // $GPVTG,096.5,T,083.5,M,0.0,N,0.0,K,D*22 + // $GPVTG,188.36,T,,M,0.820,N,1.519,K,A*3F + char type[6]; + char c_true, c_magnetic, c_knots, c_kph, c_faa_mode; + + if(!minmea_scan( + sentence, + "t;fcfcfcfcc", + type, + &frame->true_track_degrees, + &c_true, + &frame->magnetic_track_degrees, + &c_magnetic, + &frame->speed_knots, + &c_knots, + &frame->speed_kph, + &c_kph, + &c_faa_mode)) + return false; + if(strcmp(type + 2, "VTG")) return false; + // values are only valid with the accompanying characters + if(c_true != 'T') frame->true_track_degrees.scale = 0; + if(c_magnetic != 'M') frame->magnetic_track_degrees.scale = 0; + if(c_knots != 'N') frame->speed_knots.scale = 0; + if(c_kph != 'K') frame->speed_kph.scale = 0; + frame->faa_mode = (enum minmea_faa_mode)c_faa_mode; + + return true; +} + +bool minmea_parse_zda(struct minmea_sentence_zda* frame, const char* sentence) { + // $GPZDA,201530.00,04,07,2002,00,00*60 + char type[6]; + + if(!minmea_scan( + sentence, + "tTiiiii", + type, + &frame->time, + &frame->date.day, + &frame->date.month, + &frame->date.year, + &frame->hour_offset, + &frame->minute_offset)) + return false; + if(strcmp(type + 2, "ZDA")) return false; + + // check offsets + if(abs(frame->hour_offset) > 13 || frame->minute_offset > 59 || frame->minute_offset < 0) + return false; + + return true; +} + +int minmea_getdatetime( + struct tm* tm, + const struct minmea_date* date, + const struct minmea_time* time_) { + if(date->year == -1 || time_->hours == -1) return -1; + + memset(tm, 0, sizeof(*tm)); + if(date->year < 80) { + tm->tm_year = 2000 + date->year - 1900; // 2000-2079 + } else if(date->year >= 1900) { + tm->tm_year = date->year - 1900; // 4 digit year, use directly + } else { + tm->tm_year = date->year; // 1980-1999 + } + tm->tm_mon = date->month - 1; + tm->tm_mday = date->day; + tm->tm_hour = time_->hours; + tm->tm_min = time_->minutes; + tm->tm_sec = time_->seconds; + + return 0; +} + +int minmea_gettime( + struct timespec* ts, + const struct minmea_date* date, + const struct minmea_time* time_) { + struct tm tm; + if(minmea_getdatetime(&tm, date, time_)) return -1; + + time_t timestamp = mktime(&tm); /* See README.md if your system lacks timegm(). */ + if(timestamp != (time_t)-1) { + ts->tv_sec = timestamp; + ts->tv_nsec = time_->microseconds * 1000; + return 0; + } else { + return -1; + } +} + +/* vim: set ts=4 sw=4 et: */ diff --git a/applications/plugins/gps_nmea_uart/minmea.h b/applications/plugins/gps_nmea_uart/minmea.h new file mode 100644 index 000000000..88eec4ae9 --- /dev/null +++ b/applications/plugins/gps_nmea_uart/minmea.h @@ -0,0 +1,295 @@ +/* + * Copyright © 2014 Kosma Moczek + * This program is free software. It comes without any warranty, to the extent + * permitted by applicable law. You can redistribute it and/or modify it under + * the terms of the Do What The Fuck You Want To Public License, Version 2, as + * published by Sam Hocevar. See the COPYING file for more details. + */ + +#ifndef MINMEA_H +#define MINMEA_H + +#ifdef __cplusplus +extern "C" { +#endif + +#include +#include +#include +#include +#include +#ifdef MINMEA_INCLUDE_COMPAT +#include +#endif + +#ifndef MINMEA_MAX_SENTENCE_LENGTH +#define MINMEA_MAX_SENTENCE_LENGTH 80 +#endif + +enum minmea_sentence_id { + MINMEA_INVALID = -1, + MINMEA_UNKNOWN = 0, + MINMEA_SENTENCE_GBS, + MINMEA_SENTENCE_GGA, + MINMEA_SENTENCE_GLL, + MINMEA_SENTENCE_GSA, + MINMEA_SENTENCE_GST, + MINMEA_SENTENCE_GSV, + MINMEA_SENTENCE_RMC, + MINMEA_SENTENCE_VTG, + MINMEA_SENTENCE_ZDA, +}; + +struct minmea_float { + int_least32_t value; + int_least32_t scale; +}; + +struct minmea_date { + int day; + int month; + int year; +}; + +struct minmea_time { + int hours; + int minutes; + int seconds; + int microseconds; +}; + +struct minmea_sentence_gbs { + struct minmea_time time; + struct minmea_float err_latitude; + struct minmea_float err_longitude; + struct minmea_float err_altitude; + int svid; + struct minmea_float prob; + struct minmea_float bias; + struct minmea_float stddev; +}; + +struct minmea_sentence_rmc { + struct minmea_time time; + bool valid; + struct minmea_float latitude; + struct minmea_float longitude; + struct minmea_float speed; + struct minmea_float course; + struct minmea_date date; + struct minmea_float variation; +}; + +struct minmea_sentence_gga { + struct minmea_time time; + struct minmea_float latitude; + struct minmea_float longitude; + int fix_quality; + int satellites_tracked; + struct minmea_float hdop; + struct minmea_float altitude; + char altitude_units; + struct minmea_float height; + char height_units; + struct minmea_float dgps_age; +}; + +enum minmea_gll_status { + MINMEA_GLL_STATUS_DATA_VALID = 'A', + MINMEA_GLL_STATUS_DATA_NOT_VALID = 'V', +}; + +// FAA mode added to some fields in NMEA 2.3. +enum minmea_faa_mode { + MINMEA_FAA_MODE_AUTONOMOUS = 'A', + MINMEA_FAA_MODE_DIFFERENTIAL = 'D', + MINMEA_FAA_MODE_ESTIMATED = 'E', + MINMEA_FAA_MODE_MANUAL = 'M', + MINMEA_FAA_MODE_SIMULATED = 'S', + MINMEA_FAA_MODE_NOT_VALID = 'N', + MINMEA_FAA_MODE_PRECISE = 'P', +}; + +struct minmea_sentence_gll { + struct minmea_float latitude; + struct minmea_float longitude; + struct minmea_time time; + char status; + char mode; +}; + +struct minmea_sentence_gst { + struct minmea_time time; + struct minmea_float rms_deviation; + struct minmea_float semi_major_deviation; + struct minmea_float semi_minor_deviation; + struct minmea_float semi_major_orientation; + struct minmea_float latitude_error_deviation; + struct minmea_float longitude_error_deviation; + struct minmea_float altitude_error_deviation; +}; + +enum minmea_gsa_mode { + MINMEA_GPGSA_MODE_AUTO = 'A', + MINMEA_GPGSA_MODE_FORCED = 'M', +}; + +enum minmea_gsa_fix_type { + MINMEA_GPGSA_FIX_NONE = 1, + MINMEA_GPGSA_FIX_2D = 2, + MINMEA_GPGSA_FIX_3D = 3, +}; + +struct minmea_sentence_gsa { + char mode; + int fix_type; + int sats[12]; + struct minmea_float pdop; + struct minmea_float hdop; + struct minmea_float vdop; +}; + +struct minmea_sat_info { + int nr; + int elevation; + int azimuth; + int snr; +}; + +struct minmea_sentence_gsv { + int total_msgs; + int msg_nr; + int total_sats; + struct minmea_sat_info sats[4]; +}; + +struct minmea_sentence_vtg { + struct minmea_float true_track_degrees; + struct minmea_float magnetic_track_degrees; + struct minmea_float speed_knots; + struct minmea_float speed_kph; + enum minmea_faa_mode faa_mode; +}; + +struct minmea_sentence_zda { + struct minmea_time time; + struct minmea_date date; + int hour_offset; + int minute_offset; +}; + +/** + * Calculate raw sentence checksum. Does not check sentence integrity. + */ +uint8_t minmea_checksum(const char* sentence); + +/** + * Check sentence validity and checksum. Returns true for valid sentences. + */ +bool minmea_check(const char* sentence, bool strict); + +/** + * Determine talker identifier. + */ +bool minmea_talker_id(char talker[3], const char* sentence); + +/** + * Determine sentence identifier. + */ +enum minmea_sentence_id minmea_sentence_id(const char* sentence, bool strict); + +/** + * Scanf-like processor for NMEA sentences. Supports the following formats: + * c - single character (char *) + * d - direction, returned as 1/-1, default 0 (int *) + * f - fractional, returned as value + scale (struct minmea_float *) + * i - decimal, default zero (int *) + * s - string (char *) + * t - talker identifier and type (char *) + * D - date (struct minmea_date *) + * T - time stamp (struct minmea_time *) + * _ - ignore this field + * ; - following fields are optional + * Returns true on success. See library source code for details. + */ +bool minmea_scan(const char* sentence, const char* format, ...); + +/* + * Parse a specific type of sentence. Return true on success. + */ +bool minmea_parse_gbs(struct minmea_sentence_gbs* frame, const char* sentence); +bool minmea_parse_rmc(struct minmea_sentence_rmc* frame, const char* sentence); +bool minmea_parse_gga(struct minmea_sentence_gga* frame, const char* sentence); +bool minmea_parse_gsa(struct minmea_sentence_gsa* frame, const char* sentence); +bool minmea_parse_gll(struct minmea_sentence_gll* frame, const char* sentence); +bool minmea_parse_gst(struct minmea_sentence_gst* frame, const char* sentence); +bool minmea_parse_gsv(struct minmea_sentence_gsv* frame, const char* sentence); +bool minmea_parse_vtg(struct minmea_sentence_vtg* frame, const char* sentence); +bool minmea_parse_zda(struct minmea_sentence_zda* frame, const char* sentence); + +/** + * Convert GPS UTC date/time representation to a UNIX calendar time. + */ +int minmea_getdatetime( + struct tm* tm, + const struct minmea_date* date, + const struct minmea_time* time_); + +/** + * Convert GPS UTC date/time representation to a UNIX timestamp. + */ +int minmea_gettime( + struct timespec* ts, + const struct minmea_date* date, + const struct minmea_time* time_); + +/** + * Rescale a fixed-point value to a different scale. Rounds towards zero. + */ +static inline int_least32_t minmea_rescale(const struct minmea_float* f, int_least32_t new_scale) { + if(f->scale == 0) return 0; + if(f->scale == new_scale) return f->value; + if(f->scale > new_scale) + return (f->value + ((f->value > 0) - (f->value < 0)) * f->scale / new_scale / 2) / + (f->scale / new_scale); + else + return f->value * (new_scale / f->scale); +} + +/** + * Convert a fixed-point value to a floating-point value. + * Returns NaN for "unknown" values. + */ +static inline float minmea_tofloat(const struct minmea_float* f) { + if(f->scale == 0) return NAN; + return (float)f->value / (float)f->scale; +} + +/** + * Convert a raw coordinate to a floating point DD.DDD... value. + * Returns NaN for "unknown" values. + */ +static inline float minmea_tocoord(const struct minmea_float* f) { + if(f->scale == 0) return NAN; + if(f->scale > (INT_LEAST32_MAX / 100)) return NAN; + if(f->scale < (INT_LEAST32_MIN / 100)) return NAN; + int_least32_t degrees = f->value / (f->scale * 100); + int_least32_t minutes = f->value % (f->scale * 100); + return (float)degrees + (float)minutes / (60 * f->scale); +} + +/** + * Check whether a character belongs to the set of characters allowed in a + * sentence data field. + */ +static inline bool minmea_isfield(char c) { + return isprint((unsigned char)c) && c != ',' && c != '*'; +} + +#ifdef __cplusplus +} +#endif + +#endif /* MINMEA_H */ + +/* vim: set ts=4 sw=4 et: */ diff --git a/applications/plugins/heap_defence_game/hede_assets.c b/applications/plugins/heap_defence_game/hede_assets.c index ec8b933b9..f45c0583d 100644 --- a/applications/plugins/heap_defence_game/hede_assets.c +++ b/applications/plugins/heap_defence_game/hede_assets.c @@ -4,8 +4,25 @@ #include "hede_assets.h" #include -const uint8_t _A_HD_BoxDestroyed_10x10_0[] = {0x01,0x00,0x10,0x00,0x00,0x1d,0xa2,0x01,0xc8,0x80,0x6d,0x20,0x15,0x08,0x06,0x72,0x01,0x48,0x07,0xa0,}; -const uint8_t _A_HD_BoxDestroyed_10x10_1[] = {0x00,0x00,0x00,0x28,0x01,0x4A,0x00,0xA8,0x01,0x84,0x00,0x22,0x00,0x88,0x00,0x58,0x01,0x22,0x00,0x00,0x00,}; -const uint8_t _A_HD_BoxDestroyed_10x10_2[] = {0x00,0x00,0x00,0x08,0x01,0x42,0x00,0x09,0x01,0x00,0x02,0x02,0x00,0x01,0x02,0x00,0x01,0x21,0x00,0x42,0x02,}; -const uint8_t *_A_HD_BoxDestroyed_10x10[] = {_A_HD_BoxDestroyed_10x10_0,_A_HD_BoxDestroyed_10x10_1,_A_HD_BoxDestroyed_10x10_2}; -const Icon A_HD_BoxDestroyed_10x10 = {.width=10,.height=10,.frame_count=3,.frame_rate=4,.frames=_A_HD_BoxDestroyed_10x10}; \ No newline at end of file +const uint8_t _A_HD_BoxDestroyed_10x10_0[] = { + 0x01, 0x00, 0x10, 0x00, 0x00, 0x1d, 0xa2, 0x01, 0xc8, 0x80, + 0x6d, 0x20, 0x15, 0x08, 0x06, 0x72, 0x01, 0x48, 0x07, 0xa0, +}; +const uint8_t _A_HD_BoxDestroyed_10x10_1[] = { + 0x00, 0x00, 0x00, 0x28, 0x01, 0x4A, 0x00, 0xA8, 0x01, 0x84, 0x00, + 0x22, 0x00, 0x88, 0x00, 0x58, 0x01, 0x22, 0x00, 0x00, 0x00, +}; +const uint8_t _A_HD_BoxDestroyed_10x10_2[] = { + 0x00, 0x00, 0x00, 0x08, 0x01, 0x42, 0x00, 0x09, 0x01, 0x00, 0x02, + 0x02, 0x00, 0x01, 0x02, 0x00, 0x01, 0x21, 0x00, 0x42, 0x02, +}; +const uint8_t* _A_HD_BoxDestroyed_10x10[] = { + _A_HD_BoxDestroyed_10x10_0, + _A_HD_BoxDestroyed_10x10_1, + _A_HD_BoxDestroyed_10x10_2}; +const Icon A_HD_BoxDestroyed_10x10 = { + .width = 10, + .height = 10, + .frame_count = 3, + .frame_rate = 4, + .frames = _A_HD_BoxDestroyed_10x10}; \ No newline at end of file