mirror of
https://github.com/espressif/arduino-esp32
synced 2024-09-21 02:18:29 +00:00
84 lines
2.5 KiB
C
84 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
|