1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
|
#include "bt_packet_test.h"
#include "bt_test.h"
#include "bt_test_types.h"
#include "furi_hal_bt.h"
struct BtPacketTest {
BtTest* bt_test;
BtTestMode mode;
BtTestChannel channel;
BtTestDataRate data_rate;
osTimerId_t timer;
};
static BtTestParamValue bt_param_mode[] = {
{.value = BtTestModeRx, .str = "Rx"},
{.value = BtTestModeTx, .str = "Tx"},
};
static BtTestParamValue bt_param_channel[] = {
{.value = BtTestChannel2402, .str = "2402 MHz"},
{.value = BtTestChannel2440, .str = "2440 MHz"},
{.value = BtTestChannel2480, .str = "2480 MHz"},
};
static BtTestParamValue bt_param_data_rate[] = {
{.value = BtDataRate1M, .str = "1 Mbps"},
{.value = BtDataRate2M, .str = "2 Mbps"},
};
static void bt_packet_test_start(BtPacketTest* bt_packet_test) {
furi_assert(bt_packet_test);
if(bt_packet_test->mode == BtTestModeRx) {
furi_hal_bt_start_packet_rx(bt_packet_test->channel, bt_packet_test->data_rate);
osTimerStart(bt_packet_test->timer, osKernelGetTickFreq() / 4);
} else if(bt_packet_test->mode == BtTestModeTx) {
furi_hal_bt_start_packet_tx(bt_packet_test->channel, 1, bt_packet_test->data_rate);
}
}
static void bt_packet_test_stop(BtPacketTest* bt_packet_test) {
furi_assert(bt_packet_test);
if(bt_packet_test->mode == BtTestModeTx) {
furi_hal_bt_stop_packet_test();
bt_test_set_packets_tx(bt_packet_test->bt_test, furi_hal_bt_get_transmitted_packets());
} else if(bt_packet_test->mode == BtTestModeRx) {
bt_test_set_packets_rx(bt_packet_test->bt_test, furi_hal_bt_stop_packet_test());
osTimerStop(bt_packet_test->timer);
}
}
static uint32_t bt_packet_test_param_changed(BtTestParam* param, BtTestParamValue* param_val) {
furi_assert(param);
uint8_t index = bt_test_get_current_value_index(param);
bt_test_set_current_value_text(param, param_val[index].str);
return param_val[index].value;
}
static void bt_packet_test_mode_changed(BtTestParam* param) {
BtPacketTest* bt_packet_test = bt_test_get_context(param);
bt_packet_test_stop(bt_packet_test);
bt_packet_test->mode = bt_packet_test_param_changed(param, bt_param_mode);
}
static void bt_packet_test_channel_changed(BtTestParam* param) {
BtPacketTest* bt_packet_test = bt_test_get_context(param);
bt_packet_test_stop(bt_packet_test);
bt_packet_test->channel = bt_packet_test_param_changed(param, bt_param_channel);
}
static void bt_packet_test_param_channel(BtTestParam* param) {
BtPacketTest* bt_packet_test = bt_test_get_context(param);
bt_packet_test_stop(bt_packet_test);
bt_packet_test->data_rate = bt_packet_test_param_changed(param, bt_param_data_rate);
}
static void bt_packet_test_change_state_callback(BtTestState state, void* context) {
furi_assert(context);
BtPacketTest* bt_packet_test = context;
if(state == BtTestStateStarted) {
bt_packet_test_start(bt_packet_test);
} else if(state == BtTestStateStopped) {
bt_packet_test_stop(bt_packet_test);
}
}
static void bt_packet_test_exit_callback(void* context) {
furi_assert(context);
BtPacketTest* bt_packet_test = context;
bt_packet_test_stop(bt_packet_test);
}
static void bt_test_packet_timer_callback(void* context) {
furi_assert(context);
BtPacketTest* bt_packet_test = context;
if(bt_packet_test->mode == BtTestModeRx) {
bt_test_set_rssi(bt_packet_test->bt_test, furi_hal_bt_get_rssi());
}
}
BtPacketTest* bt_packet_test_alloc() {
BtPacketTest* bt_packet_test = furi_alloc(sizeof(BtPacketTest));
bt_packet_test->bt_test = bt_test_alloc();
bt_test_set_context(bt_packet_test->bt_test, bt_packet_test);
bt_test_set_change_state_callback(
bt_packet_test->bt_test, bt_packet_test_change_state_callback);
bt_test_set_back_callback(bt_packet_test->bt_test, bt_packet_test_exit_callback);
BtTestParam* param;
param = bt_test_param_add(
bt_packet_test->bt_test,
"Mode",
SIZEOF_ARRAY(bt_param_mode),
bt_packet_test_mode_changed,
bt_packet_test);
bt_test_set_current_value_index(param, 0);
bt_test_set_current_value_text(param, bt_param_mode[0].str);
bt_packet_test->mode = BtTestModeRx;
param = bt_test_param_add(
bt_packet_test->bt_test,
"Channel",
SIZEOF_ARRAY(bt_param_channel),
bt_packet_test_channel_changed,
bt_packet_test);
bt_test_set_current_value_index(param, 0);
bt_test_set_current_value_text(param, bt_param_channel[0].str);
bt_packet_test->channel = BtTestChannel2402;
param = bt_test_param_add(
bt_packet_test->bt_test,
"Data rate",
SIZEOF_ARRAY(bt_param_data_rate),
bt_packet_test_param_channel,
bt_packet_test);
bt_test_set_current_value_index(param, 0);
bt_test_set_current_value_text(param, bt_param_data_rate[0].str);
bt_packet_test->data_rate = BtDataRate1M;
bt_packet_test->timer =
osTimerNew(bt_test_packet_timer_callback, osTimerPeriodic, bt_packet_test, NULL);
return bt_packet_test;
}
void bt_packet_test_free(BtPacketTest* bt_packet_test) {
furi_assert(bt_packet_test);
bt_test_free(bt_packet_test->bt_test);
osTimerDelete(bt_packet_test->timer);
free(bt_packet_test);
}
View* bt_packet_test_get_view(BtPacketTest* bt_packet_test) {
furi_assert(bt_packet_test);
return bt_test_get_view(bt_packet_test->bt_test);
}
|
