mirror of
https://github.com/DarkFlippers/unleashed-firmware.git
synced 2024-12-18 02:41:36 +03:00
589 lines
19 KiB
C++
589 lines
19 KiB
C++
#include "flipper.h"
|
||
|
||
#include "cc1101-workaround/cc1101.h"
|
||
|
||
extern "C" void cli_print(const char* str);
|
||
|
||
#define RSSI_DELAY 5000 //rssi delay in micro second
|
||
#define CHAN_SPA 0.05 // channel spacing
|
||
|
||
int16_t rssi_to_dbm(uint8_t rssi_dec, uint8_t rssiOffset) {
|
||
int16_t rssi;
|
||
|
||
if(rssi_dec >= 128) {
|
||
rssi = (int16_t)((int16_t)(rssi_dec - 256) / 2) - rssiOffset;
|
||
} else {
|
||
rssi = (rssi_dec / 2) - rssiOffset;
|
||
}
|
||
|
||
return rssi;
|
||
}
|
||
|
||
typedef struct {
|
||
float base_freq;
|
||
uint8_t reg[3]; // FREQ2, FREQ1, FREQ0
|
||
uint8_t first_channel;
|
||
uint8_t last_channel;
|
||
uint8_t rssi_offset;
|
||
} Band;
|
||
|
||
typedef struct {
|
||
const Band* band;
|
||
uint16_t channel;
|
||
} FreqConfig;
|
||
|
||
void setup_freq(CC1101* cc1101, const FreqConfig* config) {
|
||
// cc1101->SpiWriteReg(CC1101_MCSM0, 0x08); // disalbe FS_AUTOCAL
|
||
// cc1101->SpiWriteReg(CC1101_AGCCTRL2, 0x43 | 0x0C); // MAX_DVGA_GAIN to 11 for fast rssi
|
||
// cc1101->SpiWriteReg(CC1101_AGCCTRL0, 0xB0); // max AGC WAIT_TIME; 0 filter_length
|
||
// cc1101->SetMod(GFSK); // set to GFSK for fast rssi measurement | +8 is dcfilter off
|
||
|
||
uint32_t freq_reg = config->band->base_freq * 1e6 / (F_OSC / 65536);
|
||
cc1101->SetFreq((freq_reg >> 16) & 0xFF, (freq_reg >> 8) & 0xFF, (freq_reg)&0xFF);
|
||
cc1101->SetChannel(config->channel);
|
||
|
||
/*
|
||
//set test0 to 0x09
|
||
cc1101->SpiWriteReg(CC1101_TEST0, 0x09);
|
||
//set FSCAL2 to 0x2A to force VCO HIGH
|
||
cc1101->SpiWriteReg(CC1101_FSCAL2, 0x2A);
|
||
|
||
// perform a manual calibration by issuing SCAL command
|
||
cc1101->SpiStrobe(CC1101_SCAL);
|
||
*/
|
||
}
|
||
|
||
static GpioPin debug_0 = {GPIOB, GPIO_PIN_2};
|
||
|
||
int16_t rx_rssi(CC1101* cc1101, const FreqConfig* config) {
|
||
// cc1101->SpiStrobe(CC1101_SFRX);
|
||
// cc1101->SetReceive();
|
||
|
||
// uint8_t begin_size = cc1101->SpiReadStatus(CC1101_RXBYTES);
|
||
// uint8_t rx_status = cc1101->SpiReadStatus(CC1101_MARCSTATE);
|
||
|
||
// delay_us(RSSI_DELAY);
|
||
// osDelay(15);
|
||
|
||
// uint8_t end_size = cc1101->SpiReadStatus(CC1101_RXBYTES);
|
||
|
||
// 1.4.8) read PKTSTATUS register while the radio is in RX state
|
||
/*uint8_t _pkt_status = */ // cc1101->SpiReadStatus(CC1101_PKTSTATUS);
|
||
|
||
// 1.4.9) enter IDLE state by issuing a SIDLE command
|
||
// cc1101->SpiStrobe(CC1101_SIDLE);
|
||
|
||
// //read rssi value and converto to dBm form
|
||
uint8_t rssi_dec = (uint8_t)cc1101->SpiReadStatus(CC1101_RSSI);
|
||
int16_t rssi_dBm = rssi_to_dbm(rssi_dec, config->band->rssi_offset);
|
||
|
||
/*
|
||
char buf[256];
|
||
sprintf(buf, "status: %d -> %d, rssi: %d\n", rx_status, cc1101->SpiReadStatus(CC1101_MARCSTATE), rssi_dBm);
|
||
cli_print(buf);
|
||
sprintf(buf, "begin: %d, end: %d\n", begin_size, end_size);
|
||
cli_print(buf);
|
||
*/
|
||
|
||
// uint8_t rx_data[64];
|
||
// uint8_t fifo_length = end_size - begin_size;
|
||
|
||
/*
|
||
if(fifo_length < 64) {
|
||
// cc1101->SpiReadBurstReg(CC1101_RXFIFO, rx_data, fifo_length);
|
||
|
||
*
|
||
printf("FIFO:");
|
||
for(uint8_t i = 0; i < fifo_length; i++) {
|
||
for(uint8_t bit = 0; bit < 8; bit++) {
|
||
printf("%s", (rx_data[i] & (1 << bit)) > 0 ? "1" : "0");
|
||
}
|
||
printf(" ");
|
||
}
|
||
printf("\n");
|
||
*
|
||
|
||
for(uint8_t i = 0; i < fifo_length; i++) {
|
||
for(uint8_t bit = 0; bit < 8; bit++) {
|
||
gpio_write((GpioPin*)&debug_0, (rx_data[i] & (1 << bit)) > 0);
|
||
delay_us(5);
|
||
}
|
||
}
|
||
} else {
|
||
cli_print("fifo size over\n");
|
||
}
|
||
*/
|
||
|
||
return rssi_dBm;
|
||
}
|
||
|
||
void flp_config(CC1101* cc1101) {
|
||
// cc1101->SpiWriteReg(CC1101_FSCTRL1, 0x06); //IF frequency
|
||
// cc1101->SpiWriteReg(CC1101_FSCTRL0, 0x00); //frequency offset before synthesizer
|
||
|
||
// cc1101->SpiWriteReg(CC1101_MDMCFG4, 0xCC); // RX filter bandwidth 100k(0xcc)
|
||
// cc1101->SpiWriteReg(CC1101_MDMCFG3, 0x43); //datarate config 512kBaud for the purpose of fast rssi measurement
|
||
// cc1101->SpiWriteReg(CC1101_MDMCFG1, 0x21); //FEC preamble etc. last 2 bits for channel spacing
|
||
// cc1101->SpiWriteReg(CC1101_MDMCFG0, 0xF8); //100khz channel spacing
|
||
// CC1101_CHANNR moved to SetChannel func
|
||
|
||
cc1101->SpiWriteReg(
|
||
CC1101_MCSM0, 0x18); // calibrate when going from IDLE to RX or TX ; 149 - 155 μs timeout
|
||
// MCSM0.FS_AUTOCAL[1:0] = 1
|
||
// cc1101->SpiSetRegValue(CC1101_MCSM0, 1, 5, 4); // this not work
|
||
|
||
// cc1101->SpiWriteReg(CC1101_FOCCFG, 0x16); //frequency compensation
|
||
cc1101->SpiWriteReg(CC1101_AGCCTRL2, 0x43);
|
||
cc1101->SpiWriteReg(CC1101_AGCCTRL1, 0x49);
|
||
cc1101->SpiWriteReg(CC1101_AGCCTRL0, 0x91);
|
||
|
||
//freq synthesizer calibration
|
||
cc1101->SpiWriteReg(CC1101_FSCAL3, 0xEA);
|
||
cc1101->SpiWriteReg(CC1101_FSCAL2, 0x2A);
|
||
cc1101->SpiWriteReg(CC1101_FSCAL1, 0x00);
|
||
cc1101->SpiWriteReg(CC1101_FSCAL0, 0x1F);
|
||
// cc1101->SpiWriteReg(CC1101_TEST2, 0x81);
|
||
// cc1101->SpiWriteReg(CC1101_TEST1, 0x35);
|
||
// cc1101->SpiWriteReg(CC1101_TEST0, 0x0B); //should be 0x0B for lower than 430.6MHz and 0x09 for higher
|
||
|
||
// cc1101->SpiWriteReg(CC1101_IOCFG2, 0x0D); //data output pin for asynchronous mode
|
||
// cc1101->SpiWriteReg(CC1101_IOCFG0, 0x2E); //High impedance (3-state), GDO0 configed as data input for asynchronous mode
|
||
// cc1101->SpiWriteReg(CC1101_PKTCTRL0, 0x33); //whitening off; asynchronous serial mode; CRC diable；reserved
|
||
// cc1101->SpiWriteReg(CC1101_FIFOTHR, 0x47); //Adc_retention enabled for RX filter bandwidth less than 325KHz; defalut fifo threthold.
|
||
|
||
// === Transparent mode ===
|
||
|
||
// async data out
|
||
cc1101->SpiSetRegValue(CC1101_IOCFG0, 13, 5, 0);
|
||
|
||
// FIFOTHR.ADC_RETENTION = 1
|
||
cc1101->SpiSetRegValue(CC1101_FIFOTHR, 1, 6, 6);
|
||
|
||
// PKTCTRL1.APPEND_STATUS = 0
|
||
cc1101->SpiSetRegValue(CC1101_PKTCTRL1, 0, 2, 2);
|
||
|
||
// PKTCTRL0.WHITE_DATA = 0
|
||
cc1101->SpiSetRegValue(CC1101_PKTCTRL0, 0, 6, 6);
|
||
|
||
// PKTCTRL0.LENGTH_CONFIG = 2 // Infinite packet length mode
|
||
cc1101->SpiSetRegValue(CC1101_PKTCTRL0, 2, 1, 0);
|
||
|
||
// PKTCTRL0.CRC_EN = 0
|
||
cc1101->SpiSetRegValue(CC1101_PKTCTRL0, 0, 2, 2);
|
||
|
||
// PKTCTRL0.PKT_FORMAT = 3
|
||
cc1101->SpiSetRegValue(CC1101_PKTCTRL0, 3, 5, 4);
|
||
|
||
// bandwidth 50-100 kHz
|
||
if(!cc1101->setRxBandwidth(75.0)) {
|
||
printf("wrong rx bw\n");
|
||
}
|
||
|
||
// datarate ~30 kbps
|
||
if(!cc1101->setBitRate(100.)) {
|
||
printf("wrong bitrate\n");
|
||
}
|
||
|
||
cc1101->SetReceive();
|
||
|
||
// mod
|
||
// MDMCFG2.MOD_FORMAT = 3 (3: OOK, 0: 2-FSK)
|
||
cc1101->SpiSetRegValue(CC1101_MDMCFG2, 3, 6, 4);
|
||
// MDMCFG2.SYNC_MODE = 0
|
||
cc1101->SpiSetRegValue(CC1101_MDMCFG2, 0, 2, 0);
|
||
}
|
||
|
||
void async_config(CC1101* cc1101) {
|
||
cc1101->SpiSetRegValue(CC1101_IOCFG0, 13, 5, 0); // GDO0 Output Pin Configuration
|
||
|
||
// FIFOTHR.ADC_RETENTION = 1
|
||
cc1101->SpiSetRegValue(CC1101_FIFOTHR, 1, 6, 6);
|
||
|
||
// PKTCTRL1.APPEND_STATUS = 0
|
||
cc1101->SpiSetRegValue(CC1101_PKTCTRL1, 0, 2, 2);
|
||
|
||
cc1101->SpiWriteReg(CC1101_PKTCTRL0, 0x32); // Packet Automation Control
|
||
/*
|
||
FIXME: this sequence not work
|
||
// PKTCTRL0.PKT_FORMAT = 3
|
||
cc1101->SpiSetRegValue(CC1101_PKTCTRL0, 3, 5, 4);
|
||
// PKTCTRL0.LENGTH_CONFIG = 2 // Infinite packet length mode
|
||
cc1101->SpiSetRegValue(CC1101_PKTCTRL0, 2, 1, 0);
|
||
// PKTCTRL0.CRC_EN = 0
|
||
cc1101->SpiSetRegValue(CC1101_PKTCTRL0, 0, 2, 2);
|
||
// PKTCTRL0.WHITE_DATA = 0
|
||
cc1101->SpiSetRegValue(CC1101_PKTCTRL0, 0, 6, 6);
|
||
*/
|
||
|
||
cc1101->SpiWriteReg(CC1101_MDMCFG4, 0xD6); //Modem Configuration
|
||
cc1101->SpiWriteReg(CC1101_MDMCFG3, 0xE4); //Modem Configuration
|
||
/*
|
||
FIXME: not work
|
||
// bandwidth 50-100 kHz
|
||
if(!cc1101->setRxBandwidth(75.0)) {
|
||
printf("wrong rx bw\n");
|
||
}
|
||
|
||
// datarate ~30 kbps
|
||
if(!cc1101->setBitRate(100.)) {
|
||
printf("wrong bitrate\n");
|
||
}
|
||
*/
|
||
|
||
cc1101->SpiWriteReg(CC1101_MDMCFG2, 0x30); //Modem Configuration
|
||
/*
|
||
FIXME: not work
|
||
// MDMCFG2.MOD_FORMAT = 3 (3: OOK, 0: 2-FSK)
|
||
cc1101->SpiSetRegValue(CC1101_MDMCFG2, 3, 6, 4);
|
||
// MDMCFG2.SYNC_MODE = 0
|
||
cc1101->SpiSetRegValue(CC1101_MDMCFG2, 0, 2, 0);
|
||
*/
|
||
|
||
cc1101->SpiWriteReg(CC1101_MCSM0, 0x18); //Main Radio Control State Machine Configuration
|
||
|
||
cc1101->SpiWriteReg(CC1101_FSCAL3, 0xE9); //Frequency Synthesizer Calibration
|
||
cc1101->SpiWriteReg(CC1101_FSCAL2, 0x2A); //Frequency Synthesizer Calibration
|
||
cc1101->SpiWriteReg(CC1101_FSCAL1, 0x00); //Frequency Synthesizer Calibration
|
||
cc1101->SpiWriteReg(CC1101_FSCAL0, 0x1F); //Frequency Synthesizer Calibration
|
||
}
|
||
|
||
void tx_config(CC1101* cc1101) {
|
||
// cc1101->SpiWriteReg(CC1101_IOCFG2,0x0B); //GDO2 Output Pin Configuration
|
||
// cc1101->SpiWriteReg(CC1101_IOCFG0,0x0C); //GDO0 Output Pin Configuration
|
||
cc1101->SpiSetRegValue(CC1101_IOCFG0, 13, 5, 0); // GDO0 Output Pin Configuration
|
||
|
||
cc1101->SpiWriteReg(CC1101_FIFOTHR, 0x47); //RX FIFO and TX FIFO Thresholds
|
||
cc1101->SpiWriteReg(CC1101_PKTCTRL0, 0x32); //Packet Automation Control
|
||
cc1101->SpiWriteReg(CC1101_FSCTRL1, 0x06); //Frequency Synthesizer Control
|
||
cc1101->SpiWriteReg(CC1101_FREQ2, 0x10); //Frequency Control Word, High Byte
|
||
cc1101->SpiWriteReg(CC1101_FREQ1, 0xB0); //Frequency Control Word, Middle Byte
|
||
cc1101->SpiWriteReg(CC1101_FREQ0, 0x71); //Frequency Control Word, Low Byte
|
||
cc1101->SpiWriteReg(CC1101_MDMCFG4, 0x6A); //Modem Configuration
|
||
cc1101->SpiWriteReg(CC1101_MDMCFG3, 0x2E); //Modem Configuration
|
||
cc1101->SpiWriteReg(CC1101_MDMCFG2, 0x30); //Modem Configuration
|
||
cc1101->SpiWriteReg(CC1101_DEVIATN, 0x15); //Modem Deviation Setting
|
||
cc1101->SpiWriteReg(CC1101_MCSM0, 0x18); //Main Radio Control State Machine Configuration
|
||
cc1101->SpiWriteReg(CC1101_FOCCFG, 0x16); //Frequency Offset Compensation Configuration
|
||
cc1101->SpiWriteReg(CC1101_WORCTRL, 0xFB); //Wake On Radio Control
|
||
cc1101->SpiWriteReg(CC1101_FREND0, 0x11); //Front End TX Configuration
|
||
cc1101->SpiWriteReg(CC1101_FSCAL3, 0xE9); //Frequency Synthesizer Calibration
|
||
cc1101->SpiWriteReg(CC1101_FSCAL2, 0x2A); //Frequency Synthesizer Calibration
|
||
cc1101->SpiWriteReg(CC1101_FSCAL1, 0x00); //Frequency Synthesizer Calibration
|
||
cc1101->SpiWriteReg(CC1101_FSCAL0, 0x1F); //Frequency Synthesizer Calibration
|
||
cc1101->SpiWriteReg(CC1101_TEST2, 0x81); //Various Test Settings
|
||
cc1101->SpiWriteReg(CC1101_TEST1, 0x35); //Various Test Settings
|
||
cc1101->SpiWriteReg(CC1101_TEST0, 0x09); //Various Test Settings
|
||
}
|
||
|
||
// f = (f_osc/65536) * (FREQ + CHAN * (256 + CH_SP_M) * 2^(CH_SP_E - 2))
|
||
// FREQ = f / (f_osc/65536)
|
||
// CHAN = 0
|
||
// TODO: CHAN number not implemented!
|
||
// TODO: reg values not affetcts
|
||
|
||
const Band bands[] = {
|
||
{300., {0x00, 0x00, 0x00}, 0, 255, 74},
|
||
{315., {0x00, 0x00, 0x00}, 0, 255, 74},
|
||
{348., {0x00, 0x00, 0x00}, 0, 255, 74},
|
||
{387., {0x00, 0x00, 0x00}, 0, 255, 74},
|
||
{433.92, {0x00, 0x00, 0x00}, 0, 255, 74},
|
||
{464., {0x00, 0x00, 0x00}, 0, 255, 74},
|
||
{779., {0x00, 0x00, 0x00}, 0, 255, 74},
|
||
{868., {0x00, 0x00, 0x00}, 0, 255, 74},
|
||
{915., {0x00, 0x00, 0x00}, 0, 255, 74},
|
||
{928., {0x00, 0x00, 0x00}, 0, 255, 74},
|
||
};
|
||
|
||
const FreqConfig FREQ_LIST[] = {
|
||
{&bands[0], 0},
|
||
{&bands[1], 0},
|
||
{&bands[2], 0},
|
||
{&bands[3], 0},
|
||
{&bands[4], 0},
|
||
{&bands[5], 0},
|
||
{&bands[6], 0},
|
||
{&bands[7], 0},
|
||
{&bands[8], 0},
|
||
{&bands[9], 0},
|
||
};
|
||
|
||
extern "C" void cc1101_isr() {
|
||
gpio_write((GpioPin*)&debug_0, gpio_read(&cc1101_g0_gpio));
|
||
}
|
||
|
||
typedef enum {
|
||
EventTypeTick,
|
||
EventTypeKey,
|
||
} EventType;
|
||
|
||
typedef struct {
|
||
union {
|
||
InputEvent input;
|
||
} value;
|
||
EventType type;
|
||
} AppEvent;
|
||
|
||
typedef enum { ModeRx, ModeTx } Mode;
|
||
|
||
typedef struct {
|
||
int16_t dbm;
|
||
uint8_t reg;
|
||
} TxLevel;
|
||
|
||
const TxLevel TX_LEVELS[] = {
|
||
{-10, 0},
|
||
{-5, 0},
|
||
{0, 0},
|
||
{5, 0},
|
||
};
|
||
|
||
typedef struct {
|
||
Mode mode;
|
||
size_t active_freq;
|
||
int16_t last_rssi;
|
||
size_t tx_level;
|
||
bool need_cc1101_conf;
|
||
} State;
|
||
|
||
static void render_callback(Canvas* canvas, void* ctx) {
|
||
State* state = (State*)acquire_mutex((ValueMutex*)ctx, 25);
|
||
|
||
if(!state) return;
|
||
|
||
canvas_clear(canvas);
|
||
canvas_set_color(canvas, ColorBlack);
|
||
canvas_set_font(canvas, FontPrimary);
|
||
canvas_draw_str(canvas, 2, 12, "cc1101 workaround");
|
||
|
||
{
|
||
char buf[24];
|
||
FreqConfig conf = FREQ_LIST[state->active_freq];
|
||
float freq = conf.band->base_freq + CHAN_SPA * conf.channel;
|
||
sprintf(buf, "freq: %ld.%02ld MHz", (uint32_t)freq, (uint32_t)(freq * 100.) % 100);
|
||
|
||
canvas_set_font(canvas, FontSecondary);
|
||
canvas_draw_str(canvas, 2, 25, buf);
|
||
}
|
||
|
||
{
|
||
canvas_set_font(canvas, FontSecondary);
|
||
|
||
if(state->need_cc1101_conf) {
|
||
canvas_draw_str(canvas, 2, 36, "mode: configuring...");
|
||
} else if(state->mode == ModeRx) {
|
||
canvas_draw_str(canvas, 2, 36, "mode: RX");
|
||
} else if(state->mode == ModeTx) {
|
||
canvas_draw_str(canvas, 2, 36, "mode: TX");
|
||
} else {
|
||
canvas_draw_str(canvas, 2, 36, "mode: unknown");
|
||
}
|
||
}
|
||
|
||
{
|
||
if(!state->need_cc1101_conf && state->mode == ModeRx) {
|
||
char buf[24];
|
||
sprintf(buf, "RSSI: %d dBm", state->last_rssi);
|
||
|
||
canvas_set_font(canvas, FontSecondary);
|
||
canvas_draw_str(canvas, 2, 48, buf);
|
||
}
|
||
}
|
||
|
||
{
|
||
char buf[24];
|
||
sprintf(buf, "tx level: %d dBm", TX_LEVELS[state->tx_level].dbm);
|
||
|
||
canvas_set_font(canvas, FontSecondary);
|
||
canvas_draw_str(canvas, 2, 63, buf);
|
||
}
|
||
|
||
release_mutex((ValueMutex*)ctx, state);
|
||
}
|
||
|
||
static void input_callback(InputEvent* input_event, void* ctx) {
|
||
osMessageQueueId_t event_queue = (QueueHandle_t)ctx;
|
||
|
||
AppEvent event;
|
||
event.type = EventTypeKey;
|
||
event.value.input = *input_event;
|
||
osMessageQueuePut(event_queue, &event, 0, 0);
|
||
}
|
||
|
||
extern "C" void cc1101_workaround(void* p) {
|
||
osMessageQueueId_t event_queue = osMessageQueueNew(1, sizeof(AppEvent), NULL);
|
||
furi_check(event_queue);
|
||
|
||
State _state;
|
||
_state.mode = ModeRx;
|
||
_state.active_freq = 4;
|
||
_state.need_cc1101_conf = true;
|
||
_state.last_rssi = 0;
|
||
_state.tx_level = 0;
|
||
|
||
ValueMutex state_mutex;
|
||
if(!init_mutex(&state_mutex, &_state, sizeof(State))) {
|
||
printf("[cc1101] cannot create mutex\n");
|
||
furiac_exit(NULL);
|
||
}
|
||
|
||
Widget* widget = widget_alloc();
|
||
|
||
widget_draw_callback_set(widget, render_callback, &state_mutex);
|
||
widget_input_callback_set(widget, input_callback, event_queue);
|
||
|
||
// Open GUI and register widget
|
||
Gui* gui = (Gui*)furi_open("gui");
|
||
if(gui == NULL) {
|
||
printf("[cc1101] gui is not available\n");
|
||
furiac_exit(NULL);
|
||
}
|
||
gui_add_widget(gui, widget, GuiLayerFullscreen);
|
||
|
||
gpio_init(&debug_0, GpioModeOutputPushPull);
|
||
gpio_write((GpioPin*)&debug_0, false);
|
||
|
||
printf("[cc1101] creating device\n");
|
||
GpioPin cs_pin = {CC1101_CS_GPIO_Port, CC1101_CS_Pin};
|
||
|
||
gpio_init(&cc1101_g0_gpio, GpioModeInput);
|
||
|
||
// TODO open record
|
||
GpioPin* cs_pin_record = &cs_pin;
|
||
CC1101 cc1101(cs_pin_record);
|
||
printf("[cc1101] init device\n");
|
||
|
||
uint8_t address = cc1101.Init();
|
||
if(address > 0) {
|
||
printf("[cc1101] init done: %d\n", address);
|
||
} else {
|
||
printf("[cc1101] init fail\n");
|
||
furiac_exit(NULL);
|
||
}
|
||
|
||
cc1101.SpiStrobe(CC1101_SIDLE);
|
||
|
||
// flp_config(&cc1101);
|
||
// async_config(&cc1101);
|
||
tx_config(&cc1101);
|
||
// setup_freq(&cc1101, &FREQ_LIST[4]);
|
||
// enable_cc1101_irq();
|
||
|
||
printf("init ok\n");
|
||
|
||
// TODO open record
|
||
GpioPin* led_record = (GpioPin*)&led_gpio[1];
|
||
|
||
// configure pin
|
||
gpio_init(led_record, GpioModeOutputOpenDrain);
|
||
|
||
const int16_t RSSI_THRESHOLD = -60;
|
||
|
||
// setup_freq(&cc1101, &FREQ_LIST[1]);
|
||
|
||
cc1101.SetReceive();
|
||
|
||
AppEvent event;
|
||
while(1) {
|
||
osStatus_t event_status = osMessageQueueGet(event_queue, &event, NULL, 100);
|
||
State* state = (State*)acquire_mutex_block(&state_mutex);
|
||
|
||
if(event_status == osOK) {
|
||
if(event.type == EventTypeKey) {
|
||
if(event.value.input.state && event.value.input.input == InputBack) {
|
||
printf("[cc1101] bye!\n");
|
||
// TODO remove all widgets create by app
|
||
widget_enabled_set(widget, false);
|
||
furiac_exit(NULL);
|
||
}
|
||
|
||
if(event.value.input.state && event.value.input.input == InputUp) {
|
||
if(state->active_freq > 0) {
|
||
state->active_freq--;
|
||
state->need_cc1101_conf = true;
|
||
}
|
||
}
|
||
|
||
if(event.value.input.state && event.value.input.input == InputDown) {
|
||
if(state->active_freq < (sizeof(FREQ_LIST) / sizeof(FREQ_LIST[0]) - 1)) {
|
||
state->active_freq++;
|
||
state->need_cc1101_conf = true;
|
||
}
|
||
}
|
||
|
||
if(event.value.input.state && event.value.input.input == InputLeft) {
|
||
if(state->tx_level < (sizeof(TX_LEVELS) / sizeof(TX_LEVELS[0]) - 1)) {
|
||
state->tx_level++;
|
||
} else {
|
||
state->tx_level = 0;
|
||
}
|
||
|
||
state->need_cc1101_conf = true;
|
||
}
|
||
|
||
if(event.value.input.input == InputOk) {
|
||
state->mode = event.value.input.state ? ModeTx : ModeRx;
|
||
state->need_cc1101_conf = true;
|
||
}
|
||
}
|
||
} else {
|
||
}
|
||
|
||
if(state->need_cc1101_conf) {
|
||
if(state->mode == ModeRx) {
|
||
cc1101.SpiStrobe(CC1101_SIDLE);
|
||
gpio_init(&cc1101_g0_gpio, GpioModeInput);
|
||
|
||
setup_freq(&cc1101, &FREQ_LIST[state->active_freq]);
|
||
cc1101.SetReceive();
|
||
|
||
state->last_rssi = rx_rssi(&cc1101, &FREQ_LIST[state->active_freq]);
|
||
} else if(state->mode == ModeTx) {
|
||
cc1101.SpiStrobe(CC1101_SIDLE);
|
||
|
||
setup_freq(&cc1101, &FREQ_LIST[state->active_freq]);
|
||
cc1101.SetTransmit();
|
||
gpio_init(&cc1101_g0_gpio, GpioModeOutputPushPull);
|
||
gpio_write(&cc1101_g0_gpio, false);
|
||
}
|
||
|
||
state->need_cc1101_conf = false;
|
||
}
|
||
|
||
if(!state->need_cc1101_conf && state->mode == ModeRx) {
|
||
state->last_rssi = rx_rssi(&cc1101, &FREQ_LIST[state->active_freq]);
|
||
|
||
gpio_write(led_record, state->last_rssi < RSSI_THRESHOLD);
|
||
} else if(!state->need_cc1101_conf && state->mode == ModeTx) {
|
||
/*
|
||
const uint8_t data = 0xA5;
|
||
|
||
for(uint8_t i = 0; i < 8; i++) {
|
||
gpio_write(&cc1101_g0_gpio, (data & (1 << i)) > 0);
|
||
osDelay(1);
|
||
}
|
||
gpio_write(&cc1101_g0_gpio, false);
|
||
*/
|
||
|
||
const uint16_t HALF_PERIOD = 500;
|
||
|
||
for(uint8_t n = 0; n < 4; n++) {
|
||
for(uint8_t i = 0; i < 4; i++) {
|
||
gpio_write(&cc1101_g0_gpio, true);
|
||
delay_us(3 * HALF_PERIOD);
|
||
gpio_write(&cc1101_g0_gpio, false);
|
||
delay_us(HALF_PERIOD);
|
||
}
|
||
|
||
for(uint8_t i = 0; i < 40; i++) {
|
||
gpio_write(&cc1101_g0_gpio, true);
|
||
delay_us(HALF_PERIOD);
|
||
gpio_write(&cc1101_g0_gpio, false);
|
||
delay_us(HALF_PERIOD);
|
||
}
|
||
}
|
||
}
|
||
|
||
release_mutex(&state_mutex, state);
|
||
widget_update(widget);
|
||
}
|
||
} |