2018-07-28 14:33:15 -04:00
|
|
|
#include <string.h>
|
2020-03-03 00:13:17 -05:00
|
|
|
#include <math.h>
|
2018-07-28 14:33:15 -04:00
|
|
|
|
|
|
|
#include "freertos/FreeRTOS.h"
|
2021-11-17 16:49:32 -05:00
|
|
|
#include "freertos/semphr.h"
|
2018-07-28 14:33:15 -04:00
|
|
|
#include "freertos/task.h"
|
2020-01-01 23:32:16 -05:00
|
|
|
#include "freertos/queue.h"
|
2018-07-28 14:33:15 -04:00
|
|
|
|
|
|
|
#include "esp_log.h"
|
|
|
|
#include "esp_heap_caps.h"
|
|
|
|
#include "driver/gpio.h"
|
|
|
|
#include "driver/spi_common.h"
|
|
|
|
#include "driver/spi_master.h"
|
2023-12-30 00:29:05 -05:00
|
|
|
#include "spi_common_internal.h"
|
2018-07-28 14:33:15 -04:00
|
|
|
|
|
|
|
#include "esp32-lora.h"
|
|
|
|
|
|
|
|
#define READ_REG 0x7F
|
|
|
|
#define WRITE_REG 0x80
|
|
|
|
|
|
|
|
#define PA_OUTPUT_RFO_PIN 0
|
|
|
|
#define PA_OUTPUT_PA_BOOST_PIN 1
|
|
|
|
|
|
|
|
const long long frequencies[] = { 433e+6, 866e+6, 915e+6 };
|
2020-04-30 12:47:00 -04:00
|
|
|
const long bandwidths[] = { 7.8e3, 10.4e3, 15.6e3, 20.8e3, 31.25e3, 41.7e3, 62.5e3, 125e3, 250e3, 500e3 };
|
2018-07-28 14:33:15 -04:00
|
|
|
|
|
|
|
const char *TAG = "LoRa32";
|
|
|
|
|
2021-11-17 16:49:32 -05:00
|
|
|
static QueueHandle_t dio_event_queue;
|
|
|
|
static TaskHandle_t dio_task_handle;
|
|
|
|
static SemaphoreHandle_t spi_semaphore;
|
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
uint8_t lora32_read_reg(lora32_cfg_t *lora, uint8_t address) {
|
2021-11-17 22:30:01 -05:00
|
|
|
xSemaphoreTake(spi_semaphore, portMAX_DELAY);
|
2021-11-17 16:49:32 -05:00
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
spi_transaction_t t;
|
|
|
|
memset(&t, 0, sizeof(spi_transaction_t));
|
|
|
|
|
|
|
|
t.length = 16;
|
|
|
|
t.flags = SPI_TRANS_USE_TXDATA | SPI_TRANS_USE_RXDATA;
|
|
|
|
t.tx_data[0] = address & READ_REG;
|
|
|
|
t.tx_data[1] = 0x00;
|
|
|
|
|
|
|
|
ESP_ERROR_CHECK(spi_device_transmit(lora->spi, &t));
|
|
|
|
|
2020-02-22 11:34:26 -05:00
|
|
|
ESP_LOGV(TAG, "<%2X<%2X", address, t.rx_data[1]);
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2021-11-17 22:30:01 -05:00
|
|
|
xSemaphoreGive(spi_semaphore);
|
2021-11-17 16:49:32 -05:00
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
return t.rx_data[1];
|
|
|
|
}
|
|
|
|
|
|
|
|
void lora32_write_reg(lora32_cfg_t *lora, uint8_t address, uint8_t value) {
|
2021-11-17 22:30:01 -05:00
|
|
|
xSemaphoreTake(spi_semaphore, portMAX_DELAY);
|
2021-11-17 16:49:32 -05:00
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
spi_device_handle_t spi = lora->spi;
|
|
|
|
|
|
|
|
spi_transaction_t t;
|
|
|
|
memset(&t, 0, sizeof(spi_transaction_t));
|
|
|
|
|
2020-02-22 11:34:26 -05:00
|
|
|
ESP_LOGV(TAG, ">%2X>%2X", address, value);
|
2018-07-28 14:33:15 -04:00
|
|
|
|
|
|
|
t.length = 16;
|
|
|
|
t.flags = SPI_TRANS_USE_TXDATA;
|
|
|
|
t.tx_data[0] = address | WRITE_REG;
|
|
|
|
t.tx_data[1] = value;
|
|
|
|
|
|
|
|
ESP_ERROR_CHECK(spi_device_transmit(spi, &t));
|
2021-11-17 16:49:32 -05:00
|
|
|
|
2021-11-17 22:30:01 -05:00
|
|
|
xSemaphoreGive(spi_semaphore);
|
2018-07-28 14:33:15 -04:00
|
|
|
};
|
|
|
|
|
2023-09-12 17:28:48 -04:00
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
2020-03-03 00:13:17 -05:00
|
|
|
double lora32_calc_datarate(lora32_cfg_t *lora) {
|
|
|
|
double cr = (4.0 / (long)lora->codingRate);
|
|
|
|
double sf = pow(2, lora->spreadingFactor);
|
|
|
|
double c2 = sf / bandwidths[lora->bandwidth];
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "codingRate: %d cr: %f sf: %f c2: %f", lora->codingRate, cr, sf, c2);
|
2020-03-03 00:13:17 -05:00
|
|
|
|
|
|
|
return lora->spreadingFactor * cr / c2 * 1000;
|
|
|
|
}
|
|
|
|
|
2023-09-12 17:28:48 -04:00
|
|
|
void lora32_set_explicit_header(lora32_cfg_t *lora) {
|
2021-11-19 13:52:22 -05:00
|
|
|
ESP_LOGD(TAG, "setting explicit header");
|
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
lora->implicitHeader = false;
|
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_MODEM_CONFIG_1, lora32_read_reg(lora, REG_MODEM_CONFIG_1) & 0xFE);
|
|
|
|
}
|
|
|
|
|
2023-09-12 17:28:48 -04:00
|
|
|
void lora32_set_implicit_header(lora32_cfg_t *lora) {
|
2021-11-19 13:52:22 -05:00
|
|
|
ESP_LOGD(TAG, "setting implicit header");
|
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
lora->implicitHeader = true;
|
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_MODEM_CONFIG_1, lora32_read_reg(lora, REG_MODEM_CONFIG_1) | 0x01);
|
|
|
|
}
|
|
|
|
|
2021-11-17 22:33:44 -05:00
|
|
|
void lora32_standby(lora32_cfg_t *lora) {
|
|
|
|
ESP_LOGV(TAG, "MODE_STANDBY");
|
2020-02-22 14:07:02 -05:00
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
lora32_write_reg(lora, REG_OP_MODE, MODE_LONG_RANGE_MODE | MODE_STANDBY);
|
|
|
|
}
|
|
|
|
|
|
|
|
void lora32_sleep(lora32_cfg_t *lora) {
|
2021-11-17 22:33:44 -05:00
|
|
|
ESP_LOGV(TAG, "MODE_SLEEP");
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2020-02-22 14:07:02 -05:00
|
|
|
lora32_write_reg(lora, REG_OP_MODE, MODE_LONG_RANGE_MODE | MODE_SLEEP);
|
2018-07-28 14:33:15 -04:00
|
|
|
}
|
|
|
|
|
2021-12-02 13:01:37 -05:00
|
|
|
void lora32_enable_fhss(lora32_cfg_t *lora, uint8_t period) {
|
|
|
|
lora->enableFHSS = true;
|
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_HOP_PERIOD, period);
|
|
|
|
}
|
|
|
|
|
|
|
|
void lora32_disable_fhss(lora32_cfg_t *lora) {
|
|
|
|
lora->enableFHSS = false;
|
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_HOP_PERIOD, 0);
|
|
|
|
}
|
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
void lora32_enable_tx(lora32_cfg_t *lora) {
|
2021-11-17 22:33:44 -05:00
|
|
|
lora32_standby(lora);
|
2018-07-28 14:33:15 -04:00
|
|
|
|
|
|
|
if(lora->implicitHeader)
|
2023-09-12 17:28:48 -04:00
|
|
|
lora32_set_implicit_header(lora);
|
2018-07-28 14:33:15 -04:00
|
|
|
else
|
2023-09-12 17:28:48 -04:00
|
|
|
lora32_set_explicit_header(lora);
|
2018-07-28 14:33:15 -04:00
|
|
|
|
|
|
|
// zero out receive buffer
|
|
|
|
lora32_write_reg(lora, REG_FIFO_ADDR_PTR, 0);
|
|
|
|
lora32_write_reg(lora, REG_PAYLOAD_LENGTH, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
void lora32_send(lora32_cfg_t *lora, uint8_t *data, uint8_t len) {
|
2023-09-12 17:28:48 -04:00
|
|
|
if(lora == NULL) return;
|
|
|
|
|
2021-11-17 22:30:01 -05:00
|
|
|
ESP_ERROR_CHECK(spi_device_acquire_bus(lora->spi, portMAX_DELAY));
|
2021-07-23 00:32:06 -04:00
|
|
|
|
2023-09-12 17:28:48 -04:00
|
|
|
lora32_update_dio_mapping(lora, REG_DIO_MAPPING_1, DIO0_MODE_TXDONE, DIO0_MODE_SHIFT);
|
2020-02-22 10:54:14 -05:00
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
lora32_enable_tx(lora);
|
|
|
|
|
|
|
|
uint8_t i = 0;
|
|
|
|
for(; (i < len && i < MAX_PKT_LENGTH); i++)
|
|
|
|
lora32_write_reg(lora, REG_FIFO, data[i]);
|
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_PAYLOAD_LENGTH, len);
|
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_OP_MODE, MODE_LONG_RANGE_MODE | MODE_TX);
|
2021-07-23 00:32:06 -04:00
|
|
|
|
|
|
|
spi_device_release_bus(lora->spi);
|
2018-07-28 14:33:15 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
void lora32_set_frequency(lora32_cfg_t *lora, long frequency) {
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "lora32_set_frequency: %lu", frequency);
|
2018-07-28 14:33:15 -04:00
|
|
|
uint64_t frf = ((uint64_t)frequency << 19) / 32000000;
|
|
|
|
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "REG_FRF_MSB: 0x%2X", (uint8_t)(frf >> 16));
|
|
|
|
ESP_LOGD(TAG, "REG_FRF_MID: 0x%2X", (uint8_t)(frf >> 8));
|
|
|
|
ESP_LOGD(TAG, "REG_FRF_LSB: 0x%2X", (uint8_t)(frf >> 0));
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2020-04-16 23:57:50 -04:00
|
|
|
lora32_write_reg(lora, REG_FRF_MSB, (uint8_t)(frf >> 16));
|
|
|
|
lora32_write_reg(lora, REG_FRF_MID, (uint8_t)(frf >> 8));
|
|
|
|
lora32_write_reg(lora, REG_FRF_LSB, (uint8_t)(frf >> 0));
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2020-02-11 22:58:11 -05:00
|
|
|
ESP_LOGD(TAG, "REG_FRF_MSB: 0x%2X", lora32_read_reg(lora, REG_FRF_MSB));
|
|
|
|
ESP_LOGD(TAG, "REG_FRF_MID: 0x%2X", lora32_read_reg(lora, REG_FRF_MID));
|
|
|
|
ESP_LOGD(TAG, "REG_FRF_LSB: 0x%2X", lora32_read_reg(lora, REG_FRF_LSB));
|
2018-07-28 14:33:15 -04:00
|
|
|
}
|
|
|
|
|
2020-04-16 23:57:50 -04:00
|
|
|
void lora32_set_ocp(lora32_cfg_t *lora, uint8_t ma) {
|
|
|
|
}
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2020-04-16 23:57:50 -04:00
|
|
|
void lora32_set_tx_power(lora32_cfg_t *lora, uint8_t level, uint8_t output) {
|
2018-07-28 14:33:15 -04:00
|
|
|
if(output == PA_OUTPUT_RFO_PIN) {
|
|
|
|
if(level > 14) level = 14;
|
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_PA_CONFIG, 0x70 | level);
|
|
|
|
} else {
|
2020-04-16 23:57:50 -04:00
|
|
|
if(level > 17) {
|
|
|
|
// cap power level to 20
|
|
|
|
if(level > 20) level = 20;
|
|
|
|
|
|
|
|
level -= 3;
|
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_PA_DAC, 0x07);
|
|
|
|
// TODO: set over current protection
|
|
|
|
} else {
|
|
|
|
if(level < 2) level = 2;
|
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_PA_DAC, 0x04);
|
|
|
|
// TODO: set over current protection
|
|
|
|
}
|
2018-07-28 14:33:15 -04:00
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_PA_CONFIG, PA_BOOST | (level - 2));
|
|
|
|
}
|
|
|
|
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "set_tx_power(%d, %d)", level, output);
|
2020-04-16 23:57:50 -04:00
|
|
|
|
2020-02-11 22:58:11 -05:00
|
|
|
ESP_LOGD(TAG, "REG_PA_CONFIG: 0x%2X", lora32_read_reg(lora, REG_PA_CONFIG));
|
2018-07-28 14:33:15 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
uint8_t lora32_data_available(lora32_cfg_t *lora) {
|
|
|
|
return lora32_read_reg(lora, REG_RX_NB_BYTES) - lora->fifoIdx;
|
|
|
|
}
|
|
|
|
|
2020-02-21 01:04:10 -05:00
|
|
|
void lora32_dump_regs(lora32_cfg_t *lora) {
|
2020-02-27 11:18:23 -05:00
|
|
|
uint8_t i;
|
2020-02-21 01:04:10 -05:00
|
|
|
char endline[17] = {0};
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2020-02-27 11:18:23 -05:00
|
|
|
printf(" ");
|
|
|
|
|
|
|
|
for(i = 0; i < 16; i++)
|
|
|
|
printf(" %X%s", i, (i % 2 == 1 ? " " : ""));
|
|
|
|
printf("\n");
|
|
|
|
|
|
|
|
for(i = 0; i < 127; i++) {
|
2020-02-21 01:04:10 -05:00
|
|
|
if(i % 16 == 0)
|
|
|
|
printf("0x%02X: ", i);
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2020-02-21 01:04:10 -05:00
|
|
|
char c = lora32_read_reg(lora, i);
|
|
|
|
endline[i % 16] = (c >= 32 ? c : '.');
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2020-02-21 01:04:10 -05:00
|
|
|
printf("%02X%s", c, i % 2 == 1 ? " " : "");
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2020-02-21 01:04:10 -05:00
|
|
|
if(i % 16 == 15)
|
|
|
|
printf(" %s\n", endline);
|
2018-07-28 14:33:15 -04:00
|
|
|
}
|
|
|
|
|
2020-02-21 01:04:10 -05:00
|
|
|
printf("\n");
|
2018-07-28 14:33:15 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
void lora32_toggle_reset(lora32_cfg_t *config) {
|
|
|
|
// toggle reset (L/H)
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "Toggling reset pin %d", config->reset);
|
2018-07-28 14:33:15 -04:00
|
|
|
|
|
|
|
gpio_set_level(config->reset, 0);
|
|
|
|
vTaskDelay(100 / portTICK_PERIOD_MS); // requires 100us
|
|
|
|
|
|
|
|
gpio_set_level(config->reset, 1);
|
|
|
|
vTaskDelay(100 / portTICK_PERIOD_MS); // 5ms before available
|
|
|
|
}
|
|
|
|
|
2022-02-22 01:07:04 -05:00
|
|
|
uint8_t lora32_get_spreadfactor(lora32_cfg_t *lora) {
|
2020-04-30 12:47:00 -04:00
|
|
|
return (lora32_read_reg(lora, REG_MODEM_CONFIG_2) >> 4);
|
|
|
|
}
|
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
void lora32_set_spreadfactor(lora32_cfg_t *lora, uint8_t factor) {
|
|
|
|
if(factor <= 6) {
|
|
|
|
factor = 6;
|
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_DETECTION_OPTIMIZE, DETECT_OPT_SF6);
|
|
|
|
lora32_write_reg(lora, REG_DETECTION_THRESHOLD, DETECT_THRES_SF6);
|
|
|
|
} else {
|
|
|
|
if(factor > 12) factor = 12;
|
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_DETECTION_OPTIMIZE, DETECT_OPT_OTHER);
|
|
|
|
lora32_write_reg(lora, REG_DETECTION_THRESHOLD, DETECT_THRES_OTHER);
|
|
|
|
}
|
|
|
|
|
2023-12-30 00:29:05 -05:00
|
|
|
ESP_LOGD(TAG, "lora32_set_spreadfactor: %d", factor);
|
2020-02-26 10:43:00 -05:00
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
lora32_write_reg(lora, REG_MODEM_CONFIG_2, (lora32_read_reg(lora, REG_MODEM_CONFIG_2) & 0x0F) | ((factor << 4) & 0xF0));
|
2022-02-22 01:07:04 -05:00
|
|
|
|
|
|
|
lora->spreadingFactor = factor;
|
2018-07-28 14:33:15 -04:00
|
|
|
}
|
|
|
|
|
2023-09-12 17:28:48 -04:00
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
2021-11-17 22:31:10 -05:00
|
|
|
void lora32_enable_single_rx(lora32_cfg_t *lora) {
|
|
|
|
ESP_LOGD(TAG, "MODE_RX_SINGLE");
|
2023-09-12 17:28:48 -04:00
|
|
|
lora32_standby(lora);
|
2021-11-17 22:31:10 -05:00
|
|
|
|
|
|
|
if(lora->receive != NULL) {
|
2023-09-12 17:28:48 -04:00
|
|
|
lora32_update_dio_mapping(lora, REG_DIO_MAPPING_1, DIO0_MODE_RXDONE, DIO0_MODE_SHIFT);
|
2021-11-17 22:31:10 -05:00
|
|
|
}
|
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_OP_MODE, MODE_LONG_RANGE_MODE | MODE_RX_SINGLE);
|
|
|
|
}
|
|
|
|
|
2020-02-21 01:16:06 -05:00
|
|
|
void lora32_enable_continuous_rx(lora32_cfg_t *lora) {
|
2020-02-22 14:07:02 -05:00
|
|
|
ESP_LOGD(TAG, "MODE_RX_CONTINUOUS");
|
2023-09-12 17:28:48 -04:00
|
|
|
lora32_standby(lora);
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2020-02-21 11:55:23 -05:00
|
|
|
if(lora->receive != NULL) {
|
2023-09-12 17:28:48 -04:00
|
|
|
lora32_update_dio_mapping(lora, REG_DIO_MAPPING_1, DIO0_MODE_RXDONE, DIO0_MODE_SHIFT);
|
2020-02-21 11:55:23 -05:00
|
|
|
}
|
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
lora32_write_reg(lora, REG_OP_MODE, MODE_LONG_RANGE_MODE | MODE_RX_CONTINUOUS);
|
|
|
|
}
|
|
|
|
|
2020-02-22 11:56:41 -05:00
|
|
|
void lora32_enable_cad(lora32_cfg_t *lora) {
|
2023-09-12 17:28:48 -04:00
|
|
|
lora32_standby(lora);
|
|
|
|
|
|
|
|
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);
|
|
|
|
}
|
2020-02-22 11:56:41 -05:00
|
|
|
|
2023-09-12 17:28:48 -04:00
|
|
|
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);
|
2020-02-22 11:56:41 -05:00
|
|
|
}
|
|
|
|
|
2023-09-12 17:28:48 -04:00
|
|
|
ESP_LOGV(TAG, "MODE_CAD_DETECT");
|
2020-02-22 11:56:41 -05:00
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_OP_MODE, MODE_LONG_RANGE_MODE | MODE_CAD_DETECT);
|
|
|
|
}
|
|
|
|
|
2021-12-10 01:13:50 -05:00
|
|
|
int16_t lora32_get_rssi(lora32_cfg_t *lora) {
|
|
|
|
// TODO support LF output constant of -164
|
2023-09-12 17:28:48 -04:00
|
|
|
return (-157 + lora32_read_reg(lora, REG_RSSI_VALUE)) & 0xffff;
|
2021-12-10 01:13:50 -05:00
|
|
|
}
|
|
|
|
|
|
|
|
int16_t lora32_get_packet_rssi(lora32_cfg_t *lora) {
|
|
|
|
// TODO support LF output constant of -164
|
2023-09-12 17:28:48 -04:00
|
|
|
return 0x0000 | (-157 + lora32_read_reg(lora, REG_PKT_RSSI_VALUE));
|
2021-12-10 01:13:50 -05:00
|
|
|
}
|
|
|
|
|
2020-04-30 12:47:00 -04:00
|
|
|
long lora32_get_bandwidth(lora32_cfg_t *lora) {
|
|
|
|
uint8_t bw = (lora32_read_reg(lora, REG_MODEM_CONFIG_1) >> 4);
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGV(TAG, "lora32_get_bandwidth: %d", bw);
|
2020-04-30 12:47:00 -04:00
|
|
|
|
|
|
|
if(bw > 9) return -1;
|
|
|
|
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "lora32_get_bandwidth: %ld", bandwidths[bw]);
|
2020-04-30 12:47:00 -04:00
|
|
|
|
|
|
|
return bandwidths[bw];
|
|
|
|
}
|
|
|
|
|
|
|
|
void lora32_set_ldo_flag(lora32_cfg_t *lora) {
|
2022-02-22 01:07:04 -05:00
|
|
|
long symbolDuration = 1000 / (lora32_get_bandwidth(lora) / (1L << lora32_get_spreadfactor(lora)));
|
2020-02-27 11:18:53 -05:00
|
|
|
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "symbolDuration: %ld", symbolDuration);
|
2020-04-30 12:47:00 -04:00
|
|
|
|
|
|
|
bool ldoOn = symbolDuration > 16;
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "ldoOn: %d", ldoOn);
|
2020-04-30 12:47:00 -04:00
|
|
|
|
|
|
|
uint8_t modem_config_3 = lora32_read_reg(lora, REG_MODEM_CONFIG_3);
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "modem_config_3: %d", modem_config_3);
|
2020-04-30 12:47:00 -04:00
|
|
|
modem_config_3 |= ldoOn << 3;
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "modem_config_3: %d", modem_config_3);
|
2020-04-30 12:47:00 -04:00
|
|
|
lora32_write_reg(lora, REG_MODEM_CONFIG_3, modem_config_3);
|
|
|
|
}
|
|
|
|
|
2023-09-12 17:28:48 -04:00
|
|
|
void lora32_set_bandwidth(lora32_cfg_t *lora, bandwidth bw) {
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "lora32_set_bandwidth: %d", bw);
|
2020-02-27 11:18:53 -05:00
|
|
|
|
2020-04-30 12:47:00 -04:00
|
|
|
uint8_t modem_config_1 = lora32_read_reg(lora, REG_MODEM_CONFIG_1);
|
2020-02-27 11:18:53 -05:00
|
|
|
lora32_write_reg(lora, REG_MODEM_CONFIG_1, (modem_config_1 & 0x0F) | (bw << 4));
|
2020-04-30 12:47:00 -04:00
|
|
|
|
|
|
|
lora32_set_ldo_flag(lora);
|
2020-02-27 11:18:53 -05:00
|
|
|
}
|
|
|
|
|
2020-02-26 10:46:39 -05:00
|
|
|
void lora32_set_coding_rate(lora32_cfg_t *lora, uint8_t cr) {
|
|
|
|
if(cr < 5) cr = 5;
|
|
|
|
else if(cr > 8) cr = 8;
|
2018-07-29 17:00:59 -04:00
|
|
|
|
2020-02-26 10:46:39 -05:00
|
|
|
cr = cr - 4;
|
2018-07-29 17:00:59 -04:00
|
|
|
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "lora32_set_coding_rate: %d", cr + 4);
|
2020-02-26 10:43:35 -05:00
|
|
|
|
2018-07-29 17:00:59 -04:00
|
|
|
lora32_write_reg(lora, REG_MODEM_CONFIG_1, (lora32_read_reg(lora, REG_MODEM_CONFIG_1) & 0xF1) | (cr << 1));
|
|
|
|
}
|
|
|
|
|
2020-04-16 23:57:50 -04:00
|
|
|
void lora32_set_lna(lora32_cfg_t *lora, uint8_t gain) {
|
|
|
|
// clamp gain values between 0b001 & 0b110
|
|
|
|
// NOTE: don't clamp until full REG_LNA is implmented
|
|
|
|
//if(gain == 0) gain = 1;
|
|
|
|
//else if(gain > 6) gain = 6;
|
|
|
|
|
|
|
|
uint8_t lna = lora32_read_reg(lora, REG_LNA);
|
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_LNA, lna | gain);
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "set lna: 0x%2X", lna | gain);
|
2020-04-16 23:57:50 -04:00
|
|
|
}
|
|
|
|
|
2020-02-21 11:59:40 -05:00
|
|
|
static void lora32_handle_receive(lora32_cfg_t *lora) {
|
|
|
|
uint8_t len = lora32_read_reg(lora, (lora->implicitHeader ? REG_PAYLOAD_LENGTH : REG_RX_NB_BYTES));
|
2020-02-21 12:14:42 -05:00
|
|
|
ESP_LOGD(TAG, "lora32_handle_receive packet length: %d", len);
|
2020-02-21 11:59:40 -05:00
|
|
|
|
|
|
|
// TODO: set FIFO address to RX address
|
|
|
|
uint8_t fifo_addr = lora32_read_reg(lora, REG_FIFO_RX_CURRENT_ADDR);
|
2020-02-21 12:14:42 -05:00
|
|
|
ESP_LOGD(TAG, "lora32_handle_receive current FIFO address: %d", fifo_addr);
|
2020-02-21 11:59:40 -05:00
|
|
|
|
|
|
|
lora32_write_reg(lora, REG_FIFO_ADDR_PTR, fifo_addr);
|
|
|
|
|
2021-07-23 00:32:06 -04:00
|
|
|
lora->receive(lora, len);
|
2020-02-21 11:59:40 -05:00
|
|
|
}
|
|
|
|
|
2021-11-17 16:49:32 -05:00
|
|
|
static void IRAM_ATTR lora32_dio_task(void *arg) {
|
|
|
|
// allocate lora32_cfg_t to receive config from Queu
|
|
|
|
lora32_cfg_t *lora = malloc(sizeof(lora32_cfg_t));
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "starting DIO handler task");
|
2018-07-28 14:33:15 -04:00
|
|
|
|
|
|
|
while(1) {
|
2021-11-17 16:49:32 -05:00
|
|
|
// wait for event over Queue
|
2021-12-08 15:32:06 -05:00
|
|
|
if(xQueueReceive(dio_event_queue, (void*)&lora, portMAX_DELAY) != pdPASS) continue;
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2021-07-23 00:32:06 -04:00
|
|
|
spi_device_acquire_bus(lora->spi, portMAX_DELAY);
|
|
|
|
|
2020-02-21 01:04:10 -05:00
|
|
|
// read IRQ flags
|
|
|
|
uint8_t irqs = lora32_read_reg(lora, REG_IRQ_FLAGS);
|
2023-09-12 17:28:48 -04:00
|
|
|
ESP_LOGD(TAG, "reading irqs: 0x%02X", irqs);
|
2021-11-17 16:49:32 -05:00
|
|
|
|
|
|
|
// clear IRQ flags by writing mask back
|
2020-02-21 01:04:10 -05:00
|
|
|
ESP_LOGD(TAG, "clearing irqs");
|
|
|
|
lora32_write_reg(lora, REG_IRQ_FLAGS, irqs);
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2021-11-17 22:30:01 -05:00
|
|
|
spi_device_release_bus(lora->spi);
|
|
|
|
|
2020-02-22 10:54:14 -05:00
|
|
|
// TODO handle header validation
|
|
|
|
if((irqs & IRQ_RX_DONE) == IRQ_RX_DONE) {
|
2020-02-21 11:59:40 -05:00
|
|
|
lora32_handle_receive(lora);
|
2020-02-21 11:55:01 -05:00
|
|
|
}
|
2020-02-22 10:54:14 -05:00
|
|
|
|
|
|
|
if((irqs & IRQ_TX_DONE) == IRQ_TX_DONE) {
|
2021-07-23 00:32:06 -04:00
|
|
|
if(lora->tx_done != NULL) lora->tx_done(lora);
|
2020-02-22 10:54:14 -05:00
|
|
|
}
|
2020-02-22 11:56:41 -05:00
|
|
|
|
|
|
|
bool cad_detected = false;
|
|
|
|
|
|
|
|
if((irqs & IRQ_CAD_DETECTED) == IRQ_CAD_DETECTED) {
|
|
|
|
// this is for the next clause, CAD Done callback gets true/false
|
|
|
|
cad_detected = true;
|
|
|
|
|
|
|
|
// no need for arg, cad_detected callback is always presummed true
|
2021-07-23 00:32:06 -04:00
|
|
|
if(lora->cad_detected != NULL) lora->cad_detected(lora);
|
2020-02-22 11:56:41 -05:00
|
|
|
}
|
|
|
|
|
|
|
|
if((irqs & IRQ_CAD_DONE) == IRQ_CAD_DONE) {
|
|
|
|
// cad_done gets true/false from above, when activity is detected
|
|
|
|
// these *should* fire at the same time, defaults to false
|
2021-07-23 00:32:06 -04:00
|
|
|
if(lora->cad_done != NULL) lora->cad_done(lora, cad_detected);
|
2020-02-22 11:56:41 -05:00
|
|
|
}
|
2021-12-02 13:02:08 -05:00
|
|
|
|
|
|
|
if((irqs & IRQ_FHSS_CHANGE) == IRQ_FHSS_CHANGE) {
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "switching channel %d: %d", lora->channel, lora->channels[lora->channel]);
|
2021-12-02 13:02:08 -05:00
|
|
|
|
|
|
|
if(lora->channel == 0 && lora->channels[lora->channel] == 0) continue;
|
|
|
|
|
|
|
|
if(lora->channels[lora->channel] == 0) {
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "reseting to channel 0");
|
2021-12-02 13:02:08 -05:00
|
|
|
lora->channel = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
lora32_set_frequency(lora, lora->frequency + (lora->channels[lora->channel] * bandwidths[lora->bandwidth]));
|
|
|
|
|
|
|
|
lora->channel++;
|
|
|
|
}
|
2020-02-21 01:04:10 -05:00
|
|
|
}
|
|
|
|
}
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2020-02-21 01:04:10 -05:00
|
|
|
void lora32_read_data(lora32_cfg_t *lora, uint8_t *data) {
|
|
|
|
uint8_t i = 0;
|
|
|
|
uint8_t len = lora32_read_reg(lora, (lora->implicitHeader ? REG_PAYLOAD_LENGTH : REG_RX_NB_BYTES));
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "Reading %d bytes", len);
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2020-02-21 01:04:10 -05:00
|
|
|
for(i = 0; i < len; i++) {
|
|
|
|
data[i] = lora32_read_reg(lora, REG_FIFO);
|
2018-07-28 14:33:15 -04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-12-02 13:03:05 -05:00
|
|
|
static void IRAM_ATTR lora32_on_dio(void *arg) {
|
2021-12-07 21:06:37 -05:00
|
|
|
xQueueSendFromISR(dio_event_queue, (void*)&arg, pdFALSE);
|
2018-07-28 14:33:15 -04:00
|
|
|
}
|
|
|
|
|
2021-07-23 00:32:06 -04:00
|
|
|
uint8_t lora32_spi_init(lora32_cfg_t *lora) {
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "Initializing SPI bus");
|
2021-07-23 00:32:06 -04:00
|
|
|
|
|
|
|
esp_err_t err = ESP_OK;
|
|
|
|
|
|
|
|
spi_bus_config_t buscfg = {
|
|
|
|
.miso_io_num = lora->cipo,
|
|
|
|
.mosi_io_num = lora->copi,
|
|
|
|
.sclk_io_num = lora->clk,
|
|
|
|
.quadwp_io_num = -1,
|
|
|
|
.quadhd_io_num = -1
|
|
|
|
};
|
|
|
|
|
|
|
|
if(spi_bus_get_attr(lora->spi_host) == NULL) {
|
|
|
|
// 2 should be SPI_DMA_CH_AUTO ??? but it doesn't seem to be defined
|
|
|
|
err = spi_bus_initialize(lora->spi_host, &buscfg, 2);
|
|
|
|
}
|
|
|
|
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
uint8_t lora32_init(lora32_cfg_t *lora) {
|
2023-09-12 17:28:48 -04:00
|
|
|
esp_log_level_set(TAG, ESP_LOG_DEBUG);
|
|
|
|
|
2021-11-17 16:49:32 -05:00
|
|
|
if(spi_semaphore == NULL) {
|
|
|
|
spi_semaphore = xSemaphoreCreateMutex();
|
|
|
|
}
|
|
|
|
|
2020-02-21 01:04:10 -05:00
|
|
|
gpio_config_t io_conf;
|
2023-12-30 00:29:05 -05:00
|
|
|
io_conf.intr_type = GPIO_INTR_DISABLE;
|
2020-02-21 01:04:10 -05:00
|
|
|
io_conf.mode = GPIO_MODE_OUTPUT;
|
2018-07-28 14:33:15 -04:00
|
|
|
|
|
|
|
io_conf.pin_bit_mask = (1ULL<<lora->reset)|(1ULL<<lora->nss);
|
|
|
|
io_conf.pull_down_en = 0;
|
|
|
|
io_conf.pull_up_en = 0;
|
|
|
|
gpio_config(&io_conf);
|
|
|
|
|
|
|
|
lora32_toggle_reset(lora);
|
|
|
|
// set NSS high
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGD(TAG, "Bringing NSS high: %d", lora->nss);
|
2018-07-28 14:33:15 -04:00
|
|
|
gpio_set_level(lora->nss, 1);
|
|
|
|
|
|
|
|
vTaskDelay(10 / portTICK_PERIOD_MS);
|
|
|
|
|
2021-07-23 00:32:06 -04:00
|
|
|
// SPI device setup
|
2018-07-28 14:33:15 -04:00
|
|
|
spi_device_interface_config_t devcfg = {
|
|
|
|
.clock_speed_hz = 8E6,
|
|
|
|
.flags = 0,
|
|
|
|
.mode = 0,
|
|
|
|
.spics_io_num = lora->nss,
|
|
|
|
.queue_size = 7,
|
|
|
|
};
|
|
|
|
|
2021-07-23 00:32:06 -04:00
|
|
|
ESP_ERROR_CHECK(spi_bus_add_device(lora->spi_host, &devcfg, &lora->spi));
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2020-02-21 01:04:10 -05:00
|
|
|
// initialize event groups
|
|
|
|
lora->handle.events = xEventGroupCreate();
|
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
uint8_t version = lora32_read_reg(lora, REG_VERSION);
|
|
|
|
ESP_LOGD(TAG, "lora32_get_id() == 0x%2X", version);
|
2021-11-17 22:28:46 -05:00
|
|
|
|
2023-01-17 01:58:40 -05:00
|
|
|
lora->version = version;
|
|
|
|
|
2021-11-17 22:28:46 -05:00
|
|
|
// if ID does not match, something is likely wrong on the SPI bus
|
|
|
|
if(version != 0x12) {
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGE(TAG, "REG_VERSION returned incorrectly. Expected 0x12 got 0x%02X", version);
|
2021-11-17 22:28:46 -05:00
|
|
|
|
|
|
|
return ERR_LOR_VERSION_MISMATCH;
|
|
|
|
}
|
2018-07-28 14:33:15 -04:00
|
|
|
|
|
|
|
// TODO: confirm this is happening. Before/after power measurements?
|
|
|
|
lora32_sleep(lora);
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGV(TAG, "lora32_sleep");
|
2018-07-28 14:33:15 -04:00
|
|
|
|
|
|
|
// TODO: VERIFY
|
|
|
|
lora32_set_frequency(lora, lora->frequency);
|
2020-04-30 12:47:00 -04:00
|
|
|
lora32_set_spreadfactor(lora, lora->spreadingFactor);
|
2020-02-29 19:05:32 -05:00
|
|
|
lora32_set_bandwidth(lora, lora->bandwidth);
|
|
|
|
lora32_set_coding_rate(lora, lora->codingRate);
|
2020-02-29 19:09:00 -05:00
|
|
|
|
2018-07-28 14:33:15 -04:00
|
|
|
lora32_write_reg(lora, REG_FIFO_TX_BASE_ADDR, 0x00);
|
|
|
|
lora32_write_reg(lora, REG_FIFO_RX_BASE_ADDR, 0x00);
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGV(TAG, "clear rx/tx fifos");
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2020-04-16 23:57:50 -04:00
|
|
|
lora32_set_lna(lora, 0x03);
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2020-04-30 12:47:00 -04:00
|
|
|
// enable auto AGC
|
2018-07-28 14:33:15 -04:00
|
|
|
lora32_write_reg(lora, REG_MODEM_CONFIG_3, 0x04);
|
|
|
|
|
2020-02-22 14:07:02 -05:00
|
|
|
// TODO make based on config
|
2018-07-28 14:33:15 -04:00
|
|
|
lora32_set_tx_power(lora, 17, PA_OUTPUT_PA_BOOST_PIN);
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGV(TAG, "lora32_set_tx_power");
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2021-11-17 22:33:44 -05:00
|
|
|
lora32_standby(lora);
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGV(TAG, "lora32_standby");
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2021-11-19 13:53:01 -05:00
|
|
|
if(lora->implicitHeader)
|
2023-09-12 17:28:48 -04:00
|
|
|
lora32_set_implicit_header(lora);
|
2021-11-19 13:53:01 -05:00
|
|
|
else
|
2023-09-12 17:28:48 -04:00
|
|
|
lora32_set_explicit_header(lora);
|
2021-11-19 13:53:01 -05:00
|
|
|
|
2020-02-22 14:07:02 -05:00
|
|
|
// TODO setup shouldn't be based on just receive callback
|
2018-07-28 14:33:15 -04:00
|
|
|
if(lora->receive != NULL) {
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGV(TAG, "Setting GPIO Interrupt");
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2021-12-02 13:03:05 -05:00
|
|
|
// TODO check at least one DIOx pin is not NULL
|
|
|
|
|
2023-09-06 19:45:20 -04:00
|
|
|
uint64_t pin_bit_mask = 0;
|
|
|
|
if(lora->dio0 > -1)
|
|
|
|
pin_bit_mask |= (1 << lora->dio0);
|
|
|
|
if(lora->dio1 > -1)
|
|
|
|
pin_bit_mask |= (1 << lora->dio1);
|
|
|
|
if(lora->dio2 > -1)
|
|
|
|
pin_bit_mask |= (1 << lora->dio2);
|
|
|
|
|
2023-12-30 00:29:05 -05:00
|
|
|
io_conf.intr_type = GPIO_INTR_POSEDGE;
|
2023-09-06 19:45:20 -04:00
|
|
|
io_conf.pin_bit_mask = pin_bit_mask;
|
2018-07-28 14:33:15 -04:00
|
|
|
io_conf.mode = GPIO_MODE_INPUT;
|
2023-09-06 19:45:20 -04:00
|
|
|
io_conf.pull_down_en = 1;
|
2018-07-28 14:33:15 -04:00
|
|
|
io_conf.pull_up_en = 0;
|
|
|
|
gpio_config(&io_conf);
|
|
|
|
|
2021-11-17 16:49:32 -05:00
|
|
|
// the DIO interrupt handling for every device is done from one task
|
|
|
|
if(dio_task_handle == NULL) {
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGV(TAG, "Setting callback handler and ISR service");
|
2021-11-17 16:49:32 -05:00
|
|
|
|
|
|
|
// enable global ISR service
|
|
|
|
gpio_install_isr_service(0);
|
|
|
|
|
2021-12-07 21:06:37 -05:00
|
|
|
dio_event_queue = xQueueCreate(10, sizeof(lora32_cfg_t *));
|
2021-11-17 16:49:32 -05:00
|
|
|
|
|
|
|
// this should probably be high priority
|
|
|
|
xTaskCreate(&lora32_dio_task, "lora32_dio_task", 4096, NULL, 6, &dio_task_handle);
|
|
|
|
}
|
2018-07-28 14:33:15 -04:00
|
|
|
|
2021-11-17 16:49:32 -05:00
|
|
|
// add ISR handler to the global service started (once) above
|
2023-01-17 01:58:40 -05:00
|
|
|
ESP_LOGV(TAG, "Installing ISR handler for GPIO%d", lora->dio0);
|
2021-12-02 13:03:05 -05:00
|
|
|
if(lora->dio0 > -1)
|
|
|
|
gpio_isr_handler_add(lora->dio0, lora32_on_dio, (void*)lora);
|
|
|
|
|
|
|
|
if(lora->dio1 > -1)
|
|
|
|
gpio_isr_handler_add(lora->dio1, lora32_on_dio, (void*)lora);
|
|
|
|
|
|
|
|
if(lora->dio2 > -1)
|
|
|
|
gpio_isr_handler_add(lora->dio2, lora32_on_dio, (void*)lora);
|
2018-07-28 14:33:15 -04:00
|
|
|
}
|
|
|
|
|
2023-09-06 19:45:20 -04:00
|
|
|
return ESP_OK;
|
2018-07-28 14:33:15 -04:00
|
|
|
};
|