92 lines
2.7 KiB
C
92 lines
2.7 KiB
C
/*
|
|
* SPDX-FileCopyrightText: 2019-2023 Espressif Systems (Shanghai) CO LTD
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include "esp32-hal-sigmadelta.h"
|
|
|
|
#if SOC_SDM_SUPPORTED
|
|
#include "esp32-hal.h"
|
|
#include "esp32-hal-periman.h"
|
|
#include "driver/sdm.h"
|
|
|
|
static bool sigmaDeltaDetachBus(void * bus){
|
|
esp_err_t err = sdm_channel_disable((sdm_channel_handle_t)bus);
|
|
if(err != ESP_OK){
|
|
log_w("sdm_channel_disable failed with error: %d", err);
|
|
}
|
|
err = sdm_del_channel((sdm_channel_handle_t)bus);
|
|
if(err != ESP_OK){
|
|
log_e("sdm_del_channel failed with error: %d", err);
|
|
return false;
|
|
}
|
|
return true;
|
|
}
|
|
|
|
bool sigmaDeltaAttach(uint8_t pin, uint32_t freq) //freq 1220-312500
|
|
{
|
|
perimanSetBusDeinit(ESP32_BUS_TYPE_SIGMADELTA, sigmaDeltaDetachBus);
|
|
sdm_channel_handle_t bus = NULL;
|
|
// pin may be previously attached to other peripheral -> detach it.
|
|
// if attached to sigmaDelta, detach it and set the new frequency
|
|
if(perimanGetPinBusType(pin) != ESP32_BUS_TYPE_INIT && !perimanClearPinBus(pin)){
|
|
log_e("Pin %u could not be detached.", pin);
|
|
return false;
|
|
}
|
|
sdm_config_t config = {
|
|
.gpio_num = (int)pin,
|
|
.clk_src = SDM_CLK_SRC_DEFAULT,
|
|
.sample_rate_hz = freq,
|
|
.flags = {
|
|
.invert_out = 0,
|
|
.io_loop_back = 0
|
|
}
|
|
};
|
|
esp_err_t err = sdm_new_channel(&config, &bus);
|
|
if(err != ESP_OK){
|
|
log_e("sdm_new_channel failed with error: %d", err);
|
|
return false;
|
|
}
|
|
err = sdm_channel_enable(bus);
|
|
if(err != ESP_OK){
|
|
sigmaDeltaDetachBus((void *)bus);
|
|
log_e("sdm_channel_enable failed with error: %d", err);
|
|
return false;
|
|
}
|
|
if(!perimanSetPinBus(pin, ESP32_BUS_TYPE_SIGMADELTA, (void *)bus, -1, -1)){
|
|
sigmaDeltaDetachBus((void *)bus);
|
|
return false;
|
|
}
|
|
return true;
|
|
}
|
|
|
|
bool sigmaDeltaWrite(uint8_t pin, uint8_t duty) //chan 0-x according to SOC duty 8 bit
|
|
{
|
|
sdm_channel_handle_t bus = (sdm_channel_handle_t)perimanGetPinBus(pin, ESP32_BUS_TYPE_SIGMADELTA);
|
|
if(bus != NULL){
|
|
int8_t d = duty - 128;
|
|
esp_err_t err = sdm_channel_set_duty(bus, d);
|
|
if(err != ESP_OK){
|
|
log_e("sdm_channel_set_duty failed with error: %d", err);
|
|
return false;
|
|
}
|
|
return true;
|
|
} else {
|
|
log_e("pin %u is not attached to SigmaDelta", pin);
|
|
}
|
|
return false;
|
|
}
|
|
|
|
bool sigmaDeltaDetach(uint8_t pin)
|
|
{
|
|
void * bus = perimanGetPinBus(pin, ESP32_BUS_TYPE_SIGMADELTA);
|
|
if(bus != NULL){
|
|
// will call sigmaDeltaDetachBus
|
|
return perimanClearPinBus(pin);
|
|
} else {
|
|
log_e("pin %u is not attached to SigmaDelta", pin);
|
|
}
|
|
return false;
|
|
}
|
|
#endif
|