#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
#include "driver/gpio.h"
#include "driver/ledc.h"
#include "esp_err.h"
#include "esp_log.h"
#define SERVO_PIN GPIO_NUM_4 // 伺服馬達接腳
// 一般小型伺服馬達常用50Hz,即每20ms一個週期
#define PWM_FREQ_HZ 50
#define PWM_PERIOD_US 20000
// 常見伺服馬達的脈衝範圍,實際使用時應按型號校正
#define MIN_PULSE_US 500
#define MAX_PULSE_US 2400
#define MAX_ANGLE_DEG 180
// LEDC低速模式
#define LEDC_MODE LEDC_LOW_SPEED_MODE
#define LEDC_TIMER LEDC_TIMER_0
#define LEDC_CH LEDC_CHANNEL_0
// ESP32-S3的LEDC最高為14位元
#define LEDC_RES LEDC_TIMER_14_BIT
#define DUTY_MAX ((1U << 14) - 1)
#define CONFIG_LOG_MAXIMUM_LEVEL 5
static const char *TAG = "servo";
// 初始化LEDC,產生伺服馬達所需的50Hz PWM
static void servo_init(void) {
// 計時器決定:「PWM頻率」以及「占空比解析度」
const ledc_timer_config_t timer_cfg = {
.speed_mode = LEDC_MODE,
.duty_resolution = LEDC_RES,
.timer_num = LEDC_TIMER,
.freq_hz = PWM_FREQ_HZ,
.clk_cfg = LEDC_AUTO_CLK,
};
ESP_ERROR_CHECK(ledc_timer_config(&timer_cfg));
// 設置「通道」決定:LEDC通道、計時器和輸出腳
const ledc_channel_config_t channel_cfg = {
.gpio_num = SERVO_PIN,
.speed_mode = LEDC_MODE,
.channel = LEDC_CH,
.intr_type = LEDC_INTR_DISABLE,
.timer_sel = LEDC_TIMER,
.duty = 0,
.hpoint = 0,
};
ESP_ERROR_CHECK(ledc_channel_config(&channel_cfg));
}
// 設定Servo角度,deg(角度)參數可能值:0~180
// 設定成功,傳回ESP_OK
// 角度超出範圍,傳回ESP_ERR_INVALID_ARG錯誤
static esp_err_t servo_set_angle(uint32_t deg) {
if (deg > MAX_ANGLE_DEG) return ESP_ERR_INVALID_ARG;
// 將角度換算為高電位脈衝寬度
const uint32_t pulse = MIN_PULSE_US + deg *
(MAX_PULSE_US - MIN_PULSE_US) / MAX_ANGLE_DEG;
// 將高電位脈衝寬度換算為14位元占空比
const uint32_t duty = pulse * DUTY_MAX / PWM_PERIOD_US;
ESP_LOGI(
TAG,
"角度=%lu, 脈衝=%lu us, 占空比=%lu",
(unsigned long)deg,
(unsigned long)pulse,
(unsigned long)duty
);
esp_err_t err = ledc_set_duty(LEDC_MODE, LEDC_CH, duty);
if (err != ESP_OK) return err;
// 讓新的占空比設定生效
return ledc_update_duty(LEDC_MODE, LEDC_CH);
}
void app_main(void) {
esp_log_level_set(TAG, ESP_LOG_VERBOSE);
servo_init();
while (1) {
ESP_ERROR_CHECK(servo_set_angle(30));
vTaskDelay(pdMS_TO_TICKS(1500));
ESP_ERROR_CHECK(servo_set_angle(90));
vTaskDelay(pdMS_TO_TICKS(1500));
ESP_ERROR_CHECK(servo_set_angle(180));
vTaskDelay(pdMS_TO_TICKS(1500));
}
}Loading
esp32-s3-devkitc-1
esp32-s3-devkitc-1