WIP refactor
This commit is contained in:
parent
97204f089b
commit
c690e3d425
2 changed files with 87 additions and 35 deletions
|
@ -22,6 +22,7 @@
|
||||||
#define REG_FIFO_RX_CURRENT_ADDR 0x10
|
#define REG_FIFO_RX_CURRENT_ADDR 0x10
|
||||||
#define REG_IRQ_FLAGS 0x12
|
#define REG_IRQ_FLAGS 0x12
|
||||||
#define REG_RX_NB_BYTES 0x13
|
#define REG_RX_NB_BYTES 0x13
|
||||||
|
#define REG_MODEM_STATUS 0x18
|
||||||
#define REG_PKT_RSSI_VALUE 0x1a
|
#define REG_PKT_RSSI_VALUE 0x1a
|
||||||
#define REG_RSSI_VALUE 0x1b
|
#define REG_RSSI_VALUE 0x1b
|
||||||
#define REG_MODEM_CONFIG_1 0x1d
|
#define REG_MODEM_CONFIG_1 0x1d
|
||||||
|
@ -36,6 +37,7 @@
|
||||||
#define REG_DETECTION_THRESHOLD 0x37
|
#define REG_DETECTION_THRESHOLD 0x37
|
||||||
#define REG_SYNC_WORD 0x39
|
#define REG_SYNC_WORD 0x39
|
||||||
#define REG_DIO_MAPPING_1 0x40
|
#define REG_DIO_MAPPING_1 0x40
|
||||||
|
#define REG_DIO_MAPPING_2 0x41
|
||||||
#define REG_VERSION 0x42
|
#define REG_VERSION 0x42
|
||||||
#define REG_PA_DAC 0x4D
|
#define REG_PA_DAC 0x4D
|
||||||
|
|
||||||
|
@ -72,16 +74,31 @@
|
||||||
#define DEFAULT_PREAMBLE 8
|
#define DEFAULT_PREAMBLE 8
|
||||||
#define DEFAULT_CR 5
|
#define DEFAULT_CR 5
|
||||||
|
|
||||||
#define DIO0_MODE_RXDONE 0x00
|
#define DIO0_MODE_SHIFT 6
|
||||||
#define DIO0_MODE_TXDONE 0x40
|
#define DIO0_MODE_RXDONE 0b00
|
||||||
#define DIO0_MODE_CADDET 0x80
|
#define DIO0_MODE_TXDONE 0b01
|
||||||
|
#define DIO0_MODE_CADDON 0b10
|
||||||
|
|
||||||
#define EV_DIO0 (1 << 0)
|
#define DIO1_MODE_SHIFT 4
|
||||||
|
#define DIO1_MODE_RXTIME 0b00
|
||||||
|
#define DIO1_MODE_FHSSCC 0b01
|
||||||
|
#define DIO1_MODE_CADDET 0b10
|
||||||
|
|
||||||
|
#define DIO3_MODE_SHIFT 2
|
||||||
|
#define DIO3_MODE_CADDON 0b00
|
||||||
|
#define DIO3_MODE_HEADVA 0b01
|
||||||
|
#define DIO3_MODE_CRCERR 0b10
|
||||||
|
|
||||||
|
#define DIO4_MODE_CADDET 0b00
|
||||||
|
#define DIO4_MODE_PLLLOC 0b10
|
||||||
|
#define DIO4_MODE_SHIFT 6
|
||||||
|
|
||||||
|
#define DIO5_MODE_SHIFT 4
|
||||||
|
|
||||||
#define ERR_LOR_VERSION_MISMATCH (01)
|
#define ERR_LOR_VERSION_MISMATCH (01)
|
||||||
|
|
||||||
#define LORA32_DEFAULT_CONFIG {\
|
#define LORA32_DEFAULT_CONFIG {\
|
||||||
.bandwidth = B250,\
|
.bandwidth = 7,\
|
||||||
.codingRate = 5,\
|
.codingRate = 5,\
|
||||||
.frequency = 915000000,\
|
.frequency = 915000000,\
|
||||||
.spreadingFactor = 11,\
|
.spreadingFactor = 11,\
|
||||||
|
@ -89,9 +106,9 @@
|
||||||
.implicitHeader = false,\
|
.implicitHeader = false,\
|
||||||
.useCRC = false,\
|
.useCRC = false,\
|
||||||
.fifoIdx = 0,\
|
.fifoIdx = 0,\
|
||||||
.copi = -1,\
|
.copi = 23,\
|
||||||
.cipo = -1,\
|
.cipo = 19,\
|
||||||
.clk = -1,\
|
.clk = 18,\
|
||||||
.dio0 = -1,\
|
.dio0 = -1,\
|
||||||
.dio1 = -1,\
|
.dio1 = -1,\
|
||||||
.dio2 = -1,\
|
.dio2 = -1,\
|
||||||
|
@ -108,8 +125,8 @@ typedef enum {
|
||||||
B78, B104, B156, B208, B3125, B417, B625, B125, B250, B500
|
B78, B104, B156, B208, B3125, B417, B625, B125, B250, B500
|
||||||
} bandwidth;
|
} bandwidth;
|
||||||
|
|
||||||
const long long frequencies[3];
|
extern const long long frequencies[3];
|
||||||
const long bandwidths[10];
|
extern const long bandwidths[10];
|
||||||
|
|
||||||
typedef struct lora32_cfg_t lora32_cfg_t;
|
typedef struct lora32_cfg_t lora32_cfg_t;
|
||||||
|
|
||||||
|
@ -122,12 +139,22 @@ typedef struct {
|
||||||
EventGroupHandle_t events;
|
EventGroupHandle_t events;
|
||||||
} lora32_handle_t;
|
} lora32_handle_t;
|
||||||
|
|
||||||
|
typedef struct lora32_modem_status_t {
|
||||||
|
unsigned int detected:1;
|
||||||
|
unsigned int synced:1;
|
||||||
|
unsigned int rx:1;
|
||||||
|
unsigned int valid:1;
|
||||||
|
unsigned int clear:1;
|
||||||
|
unsigned int cr:3;
|
||||||
|
} lora32_modem_status_t;
|
||||||
|
|
||||||
typedef struct lora32_cfg_t {
|
typedef struct lora32_cfg_t {
|
||||||
uint8_t fifoIdx;
|
uint8_t fifoIdx;
|
||||||
uint8_t channel;
|
uint8_t channel;
|
||||||
uint8_t bandwidth;
|
uint8_t bandwidth;
|
||||||
uint8_t spreadingFactor;
|
uint8_t spreadingFactor;
|
||||||
uint8_t codingRate;
|
uint8_t codingRate;
|
||||||
|
uint8_t version; // to be written on init by the driver
|
||||||
|
|
||||||
int8_t nss;
|
int8_t nss;
|
||||||
int8_t cipo;
|
int8_t cipo;
|
||||||
|
@ -173,7 +200,7 @@ void lora32_enable_cad(lora32_cfg_t *lora);
|
||||||
void lora32_disable_fhss(lora32_cfg_t *lora);
|
void lora32_disable_fhss(lora32_cfg_t *lora);
|
||||||
void lora32_toggle_reset(lora32_cfg_t *lora);
|
void lora32_toggle_reset(lora32_cfg_t *lora);
|
||||||
void lora32_send(lora32_cfg_t *config, uint8_t *data, uint8_t len);
|
void lora32_send(lora32_cfg_t *config, uint8_t *data, uint8_t len);
|
||||||
void lora32_set_bandwidth(lora32_cfg_t *lora, uint8_t bw);
|
void lora32_set_bandwidth(lora32_cfg_t *lora, bandwidth bw);
|
||||||
void lora32_set_coding_rate(lora32_cfg_t *lora, uint8_t cr);
|
void lora32_set_coding_rate(lora32_cfg_t *lora, uint8_t cr);
|
||||||
void lora32_set_spreadfactor(lora32_cfg_t *lora, uint8_t factor);
|
void lora32_set_spreadfactor(lora32_cfg_t *lora, uint8_t factor);
|
||||||
uint8_t lora32_get_spreadfactor(lora32_cfg_t *lora);
|
uint8_t lora32_get_spreadfactor(lora32_cfg_t *lora);
|
||||||
|
|
|
@ -70,6 +70,17 @@ void lora32_write_reg(lora32_cfg_t *lora, uint8_t address, uint8_t value) {
|
||||||
xSemaphoreGive(spi_semaphore);
|
xSemaphoreGive(spi_semaphore);
|
||||||
};
|
};
|
||||||
|
|
||||||
|
void lora32_update_dio_mapping(lora32_cfg_t *lora, uint8_t reg, uint8_t value, uint8_t shift) {
|
||||||
|
uint8_t regdio1 = lora32_read_reg(lora, reg);
|
||||||
|
|
||||||
|
// clear bits
|
||||||
|
regdio1 &= ~(0b11 << shift);
|
||||||
|
// set new values
|
||||||
|
regdio1 |= (value << shift);
|
||||||
|
|
||||||
|
lora32_write_reg(lora, reg, regdio1);
|
||||||
|
}
|
||||||
|
|
||||||
double lora32_calc_datarate(lora32_cfg_t *lora) {
|
double lora32_calc_datarate(lora32_cfg_t *lora) {
|
||||||
double cr = (4.0 / (long)lora->codingRate);
|
double cr = (4.0 / (long)lora->codingRate);
|
||||||
double sf = pow(2, lora->spreadingFactor);
|
double sf = pow(2, lora->spreadingFactor);
|
||||||
|
@ -79,7 +90,7 @@ double lora32_calc_datarate(lora32_cfg_t *lora) {
|
||||||
return lora->spreadingFactor * cr / c2 * 1000;
|
return lora->spreadingFactor * cr / c2 * 1000;
|
||||||
}
|
}
|
||||||
|
|
||||||
void lora23_set_explicit_header(lora32_cfg_t *lora) {
|
void lora32_set_explicit_header(lora32_cfg_t *lora) {
|
||||||
ESP_LOGD(TAG, "setting explicit header");
|
ESP_LOGD(TAG, "setting explicit header");
|
||||||
|
|
||||||
lora->implicitHeader = false;
|
lora->implicitHeader = false;
|
||||||
|
@ -87,7 +98,7 @@ void lora23_set_explicit_header(lora32_cfg_t *lora) {
|
||||||
lora32_write_reg(lora, REG_MODEM_CONFIG_1, lora32_read_reg(lora, REG_MODEM_CONFIG_1) & 0xFE);
|
lora32_write_reg(lora, REG_MODEM_CONFIG_1, lora32_read_reg(lora, REG_MODEM_CONFIG_1) & 0xFE);
|
||||||
}
|
}
|
||||||
|
|
||||||
void lora23_set_implicit_header(lora32_cfg_t *lora) {
|
void lora32_set_implicit_header(lora32_cfg_t *lora) {
|
||||||
ESP_LOGD(TAG, "setting implicit header");
|
ESP_LOGD(TAG, "setting implicit header");
|
||||||
|
|
||||||
lora->implicitHeader = true;
|
lora->implicitHeader = true;
|
||||||
|
@ -123,9 +134,9 @@ void lora32_enable_tx(lora32_cfg_t *lora) {
|
||||||
lora32_standby(lora);
|
lora32_standby(lora);
|
||||||
|
|
||||||
if(lora->implicitHeader)
|
if(lora->implicitHeader)
|
||||||
lora23_set_implicit_header(lora);
|
lora32_set_implicit_header(lora);
|
||||||
else
|
else
|
||||||
lora23_set_explicit_header(lora);
|
lora32_set_explicit_header(lora);
|
||||||
|
|
||||||
// zero out receive buffer
|
// zero out receive buffer
|
||||||
lora32_write_reg(lora, REG_FIFO_ADDR_PTR, 0);
|
lora32_write_reg(lora, REG_FIFO_ADDR_PTR, 0);
|
||||||
|
@ -133,9 +144,11 @@ void lora32_enable_tx(lora32_cfg_t *lora) {
|
||||||
}
|
}
|
||||||
|
|
||||||
void lora32_send(lora32_cfg_t *lora, uint8_t *data, uint8_t len) {
|
void lora32_send(lora32_cfg_t *lora, uint8_t *data, uint8_t len) {
|
||||||
|
if(lora == NULL) return;
|
||||||
|
|
||||||
ESP_ERROR_CHECK(spi_device_acquire_bus(lora->spi, portMAX_DELAY));
|
ESP_ERROR_CHECK(spi_device_acquire_bus(lora->spi, portMAX_DELAY));
|
||||||
|
|
||||||
lora32_write_reg(lora, REG_DIO_MAPPING_1, DIO0_MODE_TXDONE);
|
lora32_update_dio_mapping(lora, REG_DIO_MAPPING_1, DIO0_MODE_TXDONE, DIO0_MODE_SHIFT);
|
||||||
|
|
||||||
lora32_enable_tx(lora);
|
lora32_enable_tx(lora);
|
||||||
|
|
||||||
|
@ -264,50 +277,63 @@ void lora32_set_spreadfactor(lora32_cfg_t *lora, uint8_t factor) {
|
||||||
lora->spreadingFactor = factor;
|
lora->spreadingFactor = factor;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
lora32_modem_status_t lora32_get_status(lora32_cfg_t *lora) {
|
||||||
|
lora32_modem_status_t modem_status;
|
||||||
|
uint8_t status = lora32_read_reg(lora, REG_MODEM_STATUS);
|
||||||
|
|
||||||
|
memcpy(&modem_status, &status, 1);
|
||||||
|
|
||||||
|
return modem_status;
|
||||||
|
}
|
||||||
|
|
||||||
void lora32_enable_single_rx(lora32_cfg_t *lora) {
|
void lora32_enable_single_rx(lora32_cfg_t *lora) {
|
||||||
ESP_LOGD(TAG, "MODE_RX_SINGLE");
|
ESP_LOGD(TAG, "MODE_RX_SINGLE");
|
||||||
|
lora32_standby(lora);
|
||||||
|
|
||||||
if(lora->receive != NULL) {
|
if(lora->receive != NULL) {
|
||||||
lora32_write_reg(lora, REG_DIO_MAPPING_1, DIO0_MODE_RXDONE);
|
lora32_update_dio_mapping(lora, REG_DIO_MAPPING_1, DIO0_MODE_RXDONE, DIO0_MODE_SHIFT);
|
||||||
}
|
}
|
||||||
|
|
||||||
lora32_standby(lora);
|
|
||||||
|
|
||||||
lora32_write_reg(lora, REG_OP_MODE, MODE_LONG_RANGE_MODE | MODE_RX_SINGLE);
|
lora32_write_reg(lora, REG_OP_MODE, MODE_LONG_RANGE_MODE | MODE_RX_SINGLE);
|
||||||
}
|
}
|
||||||
|
|
||||||
void lora32_enable_continuous_rx(lora32_cfg_t *lora) {
|
void lora32_enable_continuous_rx(lora32_cfg_t *lora) {
|
||||||
ESP_LOGD(TAG, "MODE_RX_CONTINUOUS");
|
ESP_LOGD(TAG, "MODE_RX_CONTINUOUS");
|
||||||
|
lora32_standby(lora);
|
||||||
|
|
||||||
if(lora->receive != NULL) {
|
if(lora->receive != NULL) {
|
||||||
lora32_write_reg(lora, REG_DIO_MAPPING_1, DIO0_MODE_RXDONE);
|
lora32_update_dio_mapping(lora, REG_DIO_MAPPING_1, DIO0_MODE_RXDONE, DIO0_MODE_SHIFT);
|
||||||
}
|
}
|
||||||
|
|
||||||
lora32_standby(lora);
|
|
||||||
|
|
||||||
lora32_write_reg(lora, REG_OP_MODE, MODE_LONG_RANGE_MODE | MODE_RX_CONTINUOUS);
|
lora32_write_reg(lora, REG_OP_MODE, MODE_LONG_RANGE_MODE | MODE_RX_CONTINUOUS);
|
||||||
}
|
}
|
||||||
|
|
||||||
void lora32_enable_cad(lora32_cfg_t *lora) {
|
void lora32_enable_cad(lora32_cfg_t *lora) {
|
||||||
if((lora->cad_done != NULL) | (lora->cad_detected != NULL)) {
|
lora32_standby(lora);
|
||||||
ESP_LOGD(TAG, "Setting DIO0 to CAD Detect");
|
|
||||||
|
|
||||||
lora32_write_reg(lora, REG_DIO_MAPPING_1, DIO0_MODE_CADDET);
|
if(lora->cad_done != NULL) {
|
||||||
|
ESP_LOGV(TAG, "Setting DIO0 to CAD Done");
|
||||||
|
lora32_update_dio_mapping(lora, REG_DIO_MAPPING_1, DIO0_MODE_CADDON, DIO0_MODE_SHIFT);
|
||||||
}
|
}
|
||||||
|
|
||||||
ESP_LOGD(TAG, "MODE_CAD_DETECT");
|
if(lora->cad_detected != NULL) {
|
||||||
|
ESP_LOGV(TAG, "Setting DIO1 to CAD Detect");
|
||||||
|
lora32_update_dio_mapping(lora, REG_DIO_MAPPING_1, DIO1_MODE_CADDET, DIO1_MODE_SHIFT);
|
||||||
|
}
|
||||||
|
|
||||||
|
ESP_LOGV(TAG, "MODE_CAD_DETECT");
|
||||||
|
|
||||||
lora32_write_reg(lora, REG_OP_MODE, MODE_LONG_RANGE_MODE | MODE_CAD_DETECT);
|
lora32_write_reg(lora, REG_OP_MODE, MODE_LONG_RANGE_MODE | MODE_CAD_DETECT);
|
||||||
}
|
}
|
||||||
|
|
||||||
int16_t lora32_get_rssi(lora32_cfg_t *lora) {
|
int16_t lora32_get_rssi(lora32_cfg_t *lora) {
|
||||||
// TODO support LF output constant of -164
|
// TODO support LF output constant of -164
|
||||||
return -157 + lora32_read_reg(lora, REG_RSSI_VALUE);
|
return (-157 + lora32_read_reg(lora, REG_RSSI_VALUE)) & 0xffff;
|
||||||
}
|
}
|
||||||
|
|
||||||
int16_t lora32_get_packet_rssi(lora32_cfg_t *lora) {
|
int16_t lora32_get_packet_rssi(lora32_cfg_t *lora) {
|
||||||
// TODO support LF output constant of -164
|
// TODO support LF output constant of -164
|
||||||
return -157 + lora32_read_reg(lora, REG_PKT_RSSI_VALUE);
|
return 0x0000 | (-157 + lora32_read_reg(lora, REG_PKT_RSSI_VALUE));
|
||||||
}
|
}
|
||||||
|
|
||||||
long lora32_get_bandwidth(lora32_cfg_t *lora) {
|
long lora32_get_bandwidth(lora32_cfg_t *lora) {
|
||||||
|
@ -336,7 +362,7 @@ void lora32_set_ldo_flag(lora32_cfg_t *lora) {
|
||||||
lora32_write_reg(lora, REG_MODEM_CONFIG_3, modem_config_3);
|
lora32_write_reg(lora, REG_MODEM_CONFIG_3, modem_config_3);
|
||||||
}
|
}
|
||||||
|
|
||||||
void lora32_set_bandwidth(lora32_cfg_t *lora, uint8_t bw) {
|
void lora32_set_bandwidth(lora32_cfg_t *lora, bandwidth bw) {
|
||||||
ESP_LOGD(TAG, "lora32_set_bandwidth: %d", bw);
|
ESP_LOGD(TAG, "lora32_set_bandwidth: %d", bw);
|
||||||
|
|
||||||
uint8_t modem_config_1 = lora32_read_reg(lora, REG_MODEM_CONFIG_1);
|
uint8_t modem_config_1 = lora32_read_reg(lora, REG_MODEM_CONFIG_1);
|
||||||
|
@ -390,14 +416,11 @@ static void IRAM_ATTR lora32_dio_task(void *arg) {
|
||||||
// wait for event over Queue
|
// wait for event over Queue
|
||||||
if(xQueueReceive(dio_event_queue, (void*)&lora, portMAX_DELAY) != pdPASS) continue;
|
if(xQueueReceive(dio_event_queue, (void*)&lora, portMAX_DELAY) != pdPASS) continue;
|
||||||
|
|
||||||
// need a better way to log which event and from which config
|
|
||||||
//ESP_LOGI(TAG, "handling DIO0 on GPIO%d", lora->dio0);
|
|
||||||
|
|
||||||
spi_device_acquire_bus(lora->spi, portMAX_DELAY);
|
spi_device_acquire_bus(lora->spi, portMAX_DELAY);
|
||||||
|
|
||||||
// read IRQ flags
|
// read IRQ flags
|
||||||
uint8_t irqs = lora32_read_reg(lora, REG_IRQ_FLAGS);
|
uint8_t irqs = lora32_read_reg(lora, REG_IRQ_FLAGS);
|
||||||
ESP_LOGD(TAG, "reading irqs: %02X", irqs);
|
ESP_LOGD(TAG, "reading irqs: 0x%02X", irqs);
|
||||||
|
|
||||||
// clear IRQ flags by writing mask back
|
// clear IRQ flags by writing mask back
|
||||||
ESP_LOGD(TAG, "clearing irqs");
|
ESP_LOGD(TAG, "clearing irqs");
|
||||||
|
@ -484,6 +507,8 @@ uint8_t lora32_spi_init(lora32_cfg_t *lora) {
|
||||||
}
|
}
|
||||||
|
|
||||||
uint8_t lora32_init(lora32_cfg_t *lora) {
|
uint8_t lora32_init(lora32_cfg_t *lora) {
|
||||||
|
esp_log_level_set(TAG, ESP_LOG_DEBUG);
|
||||||
|
|
||||||
if(spi_semaphore == NULL) {
|
if(spi_semaphore == NULL) {
|
||||||
spi_semaphore = xSemaphoreCreateMutex();
|
spi_semaphore = xSemaphoreCreateMutex();
|
||||||
}
|
}
|
||||||
|
@ -557,9 +582,9 @@ uint8_t lora32_init(lora32_cfg_t *lora) {
|
||||||
ESP_LOGV(TAG, "lora32_standby");
|
ESP_LOGV(TAG, "lora32_standby");
|
||||||
|
|
||||||
if(lora->implicitHeader)
|
if(lora->implicitHeader)
|
||||||
lora23_set_implicit_header(lora);
|
lora32_set_implicit_header(lora);
|
||||||
else
|
else
|
||||||
lora23_set_explicit_header(lora);
|
lora32_set_explicit_header(lora);
|
||||||
|
|
||||||
// TODO setup shouldn't be based on just receive callback
|
// TODO setup shouldn't be based on just receive callback
|
||||||
if(lora->receive != NULL) {
|
if(lora->receive != NULL) {
|
||||||
|
|
Loading…
Reference in a new issue