You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
135 lines
3.1 KiB
135 lines
3.1 KiB
/* |
|
* Copyright (c) 2021 Fabio Baltieri |
|
* |
|
* SPDX-License-Identifier: Apache-2.0 |
|
*/ |
|
|
|
#include <zephyr/kernel.h> |
|
|
|
#include "sx126x_common.h" |
|
|
|
#include <stm32wlxx_ll_exti.h> |
|
#include <stm32wlxx_ll_pwr.h> |
|
#include <stm32wlxx_ll_rcc.h> |
|
|
|
#include <zephyr/logging/log.h> |
|
#include <zephyr/irq.h> |
|
LOG_MODULE_DECLARE(sx126x, CONFIG_LORA_LOG_LEVEL); |
|
|
|
static const enum { |
|
RFO_LP, |
|
RFO_HP, |
|
} pa_output = DT_INST_STRING_UPPER_TOKEN(0, power_amplifier_output); |
|
|
|
void sx126x_reset(struct sx126x_data *dev_data) |
|
{ |
|
LL_RCC_RF_EnableReset(); |
|
k_sleep(K_MSEC(20)); |
|
LL_RCC_RF_DisableReset(); |
|
k_sleep(K_MSEC(10)); |
|
} |
|
|
|
bool sx126x_is_busy(struct sx126x_data *dev_data) |
|
{ |
|
return LL_PWR_IsActiveFlag_RFBUSYS(); |
|
} |
|
|
|
uint32_t sx126x_get_dio1_pin_state(struct sx126x_data *dev_data) |
|
{ |
|
return 0; |
|
} |
|
|
|
void sx126x_dio1_irq_enable(struct sx126x_data *dev_data) |
|
{ |
|
NVIC_ClearPendingIRQ(DT_INST_IRQN(0)); |
|
irq_enable(DT_INST_IRQN(0)); |
|
} |
|
|
|
void sx126x_dio1_irq_disable(struct sx126x_data *dev_data) |
|
{ |
|
irq_disable(DT_INST_IRQN(0)); |
|
} |
|
|
|
void sx126x_set_tx_params(int8_t power, RadioRampTimes_t ramp_time) |
|
{ |
|
uint8_t buf[2]; |
|
|
|
if (pa_output == RFO_LP) { |
|
const int8_t max_power = DT_INST_PROP(0, rfo_lp_max_power); |
|
|
|
if (power > max_power) { |
|
power = max_power; |
|
} |
|
if (max_power == 15) { |
|
SX126xSetPaConfig(0x07, 0x00, 0x01, 0x01); |
|
power = 14 - (max_power - power); |
|
} else if (max_power == 10) { |
|
SX126xSetPaConfig(0x01, 0x00, 0x01, 0x01); |
|
power = 13 - (max_power - power); |
|
} else { /* default +14 dBm */ |
|
SX126xSetPaConfig(0x04, 0x00, 0x01, 0x01); |
|
power = 14 - (max_power - power); |
|
} |
|
if (power < -17) { |
|
power = -17; |
|
} |
|
|
|
/* PA overcurrent protection limit 60 mA */ |
|
SX126xWriteRegister(REG_OCP, 0x18); |
|
} else { /* RFO_HP */ |
|
/* Better Resistance of the RFO High Power Tx to Antenna |
|
* Mismatch, see STM32WL Erratasheet |
|
*/ |
|
SX126xWriteRegister(REG_TX_CLAMP_CFG, |
|
SX126xReadRegister(REG_TX_CLAMP_CFG) |
|
| (0x0F << 1)); |
|
|
|
const int8_t max_power = DT_INST_PROP(0, rfo_hp_max_power); |
|
|
|
if (power > max_power) { |
|
power = max_power; |
|
} |
|
if (max_power == 20) { |
|
SX126xSetPaConfig(0x03, 0x05, 0x00, 0x01); |
|
power = 22 - (max_power - power); |
|
} else if (max_power == 17) { |
|
SX126xSetPaConfig(0x02, 0x03, 0x00, 0x01); |
|
power = 22 - (max_power - power); |
|
} else if (max_power == 14) { |
|
SX126xSetPaConfig(0x02, 0x02, 0x00, 0x01); |
|
power = 14 - (max_power - power); |
|
} else { /* default +22 dBm */ |
|
SX126xSetPaConfig(0x04, 0x07, 0x00, 0x01); |
|
power = 22 - (max_power - power); |
|
} |
|
if (power < -9) { |
|
power = -9; |
|
} |
|
|
|
/* PA overcurrent protection limit 140 mA */ |
|
SX126xWriteRegister(REG_OCP, 0x38); |
|
} |
|
|
|
buf[0] = power; |
|
buf[1] = (uint8_t)ramp_time; |
|
SX126xWriteCommand(RADIO_SET_TXPARAMS, buf, 2); |
|
} |
|
|
|
static void radio_isr(const struct device *dev) |
|
{ |
|
struct sx126x_data *dev_data = dev->data; |
|
|
|
irq_disable(DT_INST_IRQN(0)); |
|
k_work_submit(&dev_data->dio1_irq_work); |
|
} |
|
|
|
int sx126x_variant_init(const struct device *dev) |
|
{ |
|
IRQ_CONNECT(DT_INST_IRQN(0), |
|
DT_INST_IRQ(0, priority), |
|
radio_isr, DEVICE_DT_INST_GET(0), 0); |
|
LL_EXTI_EnableIT_32_63(LL_EXTI_LINE_44); |
|
irq_enable(DT_INST_IRQN(0)); |
|
|
|
return 0; |
|
}
|
|
|