da5c6ab9ae
* Add Config * Add Cache and remove pre-commit action * [pre-commit.ci lite] apply automatic fixes * Remove freeze * Fix * Update action * Use latest stable Python 3 version * Improve caching * Improve cache tag * Improve bot message * fix(typos): Fix typos * fix(typos): Fix more typos * refactor(udp_server): Convert script from Python 2 to 3 * Fix whitespace * Clang-format fixes * Prettier fixes * Black formatting * Manual fixes * Line endings * Fix flake and make Vale manual * Fix flake and reformat --------- Co-authored-by: pre-commit-ci-lite[bot] <117423508+pre-commit-ci-lite[bot]@users.noreply.github.com> Co-authored-by: Rodrigo Garcia <rodrigo.garcia@espressif.com>
90 lines
2.5 KiB
C
90 lines
2.5 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
|