* api-hal-bt: separate bt init to core init and app start * bt: add continuous TX and RX tests * bt: finish rx test on Back button click * api-hal-bt: check core 2 started, same f4 and f5 implementation * bt: refactoring, move hopping test logic to main thread Co-authored-by: あく <alleteam@gmail.com>
		
			
				
	
	
		
			189 lines
		
	
	
		
			7.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			189 lines
		
	
	
		
			7.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
#include "bt_views.h"
 | 
						|
 | 
						|
void bt_view_test_tone_tx_draw(Canvas* canvas, void* model) {
 | 
						|
    BtViewTestToneTxModel* m = model;
 | 
						|
    canvas_clear(canvas);
 | 
						|
    canvas_set_font(canvas, FontSecondary);
 | 
						|
    canvas_draw_str(canvas, 0, 12, "Performing continous TX test");
 | 
						|
    if(m->type == BtStatusToneTx) {
 | 
						|
        canvas_draw_str(canvas, 0, 24, "Manual control mode");
 | 
						|
    } else {
 | 
						|
        canvas_draw_str(canvas, 0, 24, "Hopping mode");
 | 
						|
    }
 | 
						|
    char buffer[32];
 | 
						|
    snprintf(buffer, sizeof(buffer), "Channel:%d MHz", m->channel * 2 + 2402);
 | 
						|
    canvas_draw_str(canvas, 0, 36, buffer);
 | 
						|
    snprintf(buffer, sizeof(buffer), "Power:%d dB", m->power - BtPower0dB);
 | 
						|
    canvas_draw_str(canvas, 0, 48, buffer);
 | 
						|
}
 | 
						|
 | 
						|
void bt_view_test_tone_rx_draw(Canvas* canvas, void* model) {
 | 
						|
    BtViewTestRxModel* m = model;
 | 
						|
    canvas_clear(canvas);
 | 
						|
    canvas_set_font(canvas, FontSecondary);
 | 
						|
    canvas_draw_str(canvas, 0, 12, "Performing continous RX test");
 | 
						|
    char buffer[32];
 | 
						|
    snprintf(buffer, sizeof(buffer), "Channel:%d MHz", m->channel * 2 + 2402);
 | 
						|
    canvas_draw_str(canvas, 0, 24, buffer);
 | 
						|
}
 | 
						|
 | 
						|
void bt_view_test_packet_tx_draw(Canvas* canvas, void* model) {
 | 
						|
    BtViewTestPacketTxModel* m = model;
 | 
						|
    canvas_clear(canvas);
 | 
						|
    canvas_set_font(canvas, FontSecondary);
 | 
						|
    canvas_draw_str(canvas, 0, 12, "Packets send TX test");
 | 
						|
    if(m->type == BtStatusPacketSetup) {
 | 
						|
        canvas_draw_str(canvas, 0, 24, "Setup parameters");
 | 
						|
        canvas_draw_str(canvas, 0, 36, "Press OK to send packets");
 | 
						|
    } else {
 | 
						|
        canvas_draw_str(canvas, 0, 24, "Sending packets");
 | 
						|
        canvas_draw_str(canvas, 0, 36, "Packets parameters:");
 | 
						|
    }
 | 
						|
    char buffer[32];
 | 
						|
    snprintf(buffer, sizeof(buffer), "Channel:%d MHz", m->channel * 2 + 2402);
 | 
						|
    canvas_draw_str(canvas, 0, 48, buffer);
 | 
						|
    snprintf(buffer, sizeof(buffer), "Daterate:%d Mbps", m->datarate);
 | 
						|
    canvas_draw_str(canvas, 0, 60, buffer);
 | 
						|
}
 | 
						|
 | 
						|
void bt_view_app_draw(Canvas* canvas, void* model) {
 | 
						|
    canvas_clear(canvas);
 | 
						|
    canvas_set_font(canvas, FontSecondary);
 | 
						|
    canvas_draw_str(canvas, 0, 12, "Start BLE app");
 | 
						|
}
 | 
						|
 | 
						|
BtTestChannel bt_switch_channel(InputKey key, BtTestChannel inst_chan) {
 | 
						|
    uint8_t pos = 0;
 | 
						|
    BtTestChannel arr[] = {BtChannel2402, BtChannel2440, BtChannel2480};
 | 
						|
    for(pos = 0; pos < sizeof(arr); pos++) {
 | 
						|
        if(arr[pos] == inst_chan) {
 | 
						|
            break;
 | 
						|
        }
 | 
						|
    }
 | 
						|
    if(key == InputKeyRight) {
 | 
						|
        pos = (pos + 1) % sizeof(arr);
 | 
						|
        return arr[pos];
 | 
						|
    } else if(key == InputKeyLeft) {
 | 
						|
        if(pos) {
 | 
						|
            return arr[pos - 1];
 | 
						|
        } else {
 | 
						|
            return arr[sizeof(arr) - 1];
 | 
						|
        }
 | 
						|
    }
 | 
						|
    return arr[0];
 | 
						|
}
 | 
						|
 | 
						|
bool bt_view_test_tone_tx_input(InputEvent* event, void* context) {
 | 
						|
    furi_assert(event);
 | 
						|
    furi_assert(context);
 | 
						|
    Bt* bt = context;
 | 
						|
    if(event->type == InputTypeShort) {
 | 
						|
        if(event->key == InputKeyBack) {
 | 
						|
            if(osTimerIsRunning(bt->hopping_mode_timer)) {
 | 
						|
                osTimerStop(bt->hopping_mode_timer);
 | 
						|
            }
 | 
						|
            BtMessage m = {.type = BtMessageTypeStopTestToneTx};
 | 
						|
            furi_check(osMessageQueuePut(bt->message_queue, &m, 0, osWaitForever) == osOK);
 | 
						|
            view_dispatcher_switch_to_view(bt->view_dispatcher, VIEW_NONE);
 | 
						|
            return true;
 | 
						|
        } else {
 | 
						|
            if(event->key == InputKeyRight || event->key == InputKeyLeft) {
 | 
						|
                bt->state.param.channel = bt_switch_channel(event->key, bt->state.param.channel);
 | 
						|
            } else if(event->key == InputKeyUp) {
 | 
						|
                if(bt->state.param.power < BtPower6dB) {
 | 
						|
                    bt->state.param.power += 2;
 | 
						|
                }
 | 
						|
            } else if(event->key == InputKeyDown) {
 | 
						|
                if(bt->state.param.power > BtPower0dB) {
 | 
						|
                    bt->state.param.power -= 2;
 | 
						|
                }
 | 
						|
            } else if(event->key == InputKeyOk) {
 | 
						|
                if(bt->state.type == BtStatusToneTx) {
 | 
						|
                    bt->state.type = BtStatusHoppingTx;
 | 
						|
                    osTimerStart(bt->hopping_mode_timer, 2000);
 | 
						|
                } else {
 | 
						|
                    bt->state.type = BtStatusToneTx;
 | 
						|
                    osTimerStop(bt->hopping_mode_timer);
 | 
						|
                }
 | 
						|
            }
 | 
						|
            BtMessage m = {
 | 
						|
                .type = BtMessageTypeStartTestToneTx,
 | 
						|
                .param.channel = bt->state.param.channel,
 | 
						|
                .param.power = bt->state.param.power};
 | 
						|
            furi_check(osMessageQueuePut(bt->message_queue, &m, 0, osWaitForever) == osOK);
 | 
						|
            return true;
 | 
						|
        }
 | 
						|
    }
 | 
						|
    return false;
 | 
						|
}
 | 
						|
 | 
						|
bool bt_view_test_tone_rx_input(InputEvent* event, void* context) {
 | 
						|
    furi_assert(event);
 | 
						|
    furi_assert(context);
 | 
						|
    Bt* bt = context;
 | 
						|
    if(event->type == InputTypeShort) {
 | 
						|
        if(event->key == InputKeyRight || event->key == InputKeyLeft) {
 | 
						|
            bt->state.param.channel = bt_switch_channel(event->key, bt->state.param.channel);
 | 
						|
            BtMessage m = {
 | 
						|
                .type = BtMessageTypeStartTestRx, .param.channel = bt->state.param.channel};
 | 
						|
            furi_check(osMessageQueuePut(bt->message_queue, &m, 0, osWaitForever) == osOK);
 | 
						|
            return true;
 | 
						|
        } else if(event->key == InputKeyBack) {
 | 
						|
            BtMessage m = {.type = BtMessageTypeStopTestRx};
 | 
						|
            furi_check(osMessageQueuePut(bt->message_queue, &m, 0, osWaitForever) == osOK);
 | 
						|
            view_dispatcher_switch_to_view(bt->view_dispatcher, VIEW_NONE);
 | 
						|
            return true;
 | 
						|
        } else {
 | 
						|
            return false;
 | 
						|
        }
 | 
						|
    }
 | 
						|
    return false;
 | 
						|
}
 | 
						|
 | 
						|
bool bt_view_test_packet_tx_input(InputEvent* event, void* context) {
 | 
						|
    furi_assert(event);
 | 
						|
    furi_assert(context);
 | 
						|
    Bt* bt = context;
 | 
						|
    if(event->type == InputTypeShort) {
 | 
						|
        if(event->key < InputKeyOk) {
 | 
						|
            // Process InputKeyUp, InputKeyDown, InputKeyLeft, InputKeyRight
 | 
						|
            if(event->key == InputKeyRight || event->key == InputKeyLeft) {
 | 
						|
                bt->state.param.channel = bt_switch_channel(event->key, bt->state.param.channel);
 | 
						|
            } else if(event->key == InputKeyUp) {
 | 
						|
                if(bt->state.param.datarate < BtDateRate2M) {
 | 
						|
                    bt->state.param.datarate += 1;
 | 
						|
                }
 | 
						|
            } else if(event->key == InputKeyDown) {
 | 
						|
                if(bt->state.param.datarate > BtDateRate1M) {
 | 
						|
                    bt->state.param.datarate -= 1;
 | 
						|
                }
 | 
						|
            }
 | 
						|
            bt->state.type = BtStatusPacketSetup;
 | 
						|
            BtMessage m = {
 | 
						|
                .type = BtMessageTypeSetupTestPacketTx,
 | 
						|
                .param.channel = bt->state.param.channel,
 | 
						|
                .param.datarate = bt->state.param.datarate,
 | 
						|
            };
 | 
						|
            furi_check(osMessageQueuePut(bt->message_queue, &m, 0, osWaitForever) == osOK);
 | 
						|
            return true;
 | 
						|
        } else if(event->key == InputKeyOk) {
 | 
						|
            bt->state.type = BtStatusPacketTx;
 | 
						|
            BtMessage m = {
 | 
						|
                .type = BtMessageTypeStartTestPacketTx,
 | 
						|
                .param.channel = bt->state.param.channel,
 | 
						|
                .param.datarate = bt->state.param.datarate,
 | 
						|
            };
 | 
						|
            furi_check(osMessageQueuePut(bt->message_queue, &m, 0, osWaitForever) == osOK);
 | 
						|
            return true;
 | 
						|
        } else if(event->key == InputKeyBack) {
 | 
						|
            BtMessage m = {
 | 
						|
                .type = BtMessageTypeStopTestPacketTx,
 | 
						|
            };
 | 
						|
            furi_check(osMessageQueuePut(bt->message_queue, &m, 0, osWaitForever) == osOK);
 | 
						|
            view_dispatcher_switch_to_view(bt->view_dispatcher, VIEW_NONE);
 | 
						|
            return true;
 | 
						|
        }
 | 
						|
    }
 | 
						|
    return false;
 | 
						|
}
 |