【ESP32 C++教程】Unit5-2 执行器件之舵机

本节主要讲解舵机驱动类和用按键控制舵机。

舵机是一种位置(角度)伺服的驱动器,适用于那些需要角度不断变化并可以保持的控制系统。在高档遥控玩具,如飞机、潜艇模型,遥控机器人中已经得到了普遍应用。

【ESP32 C++教程】Unit5-2 执行器件之舵机
舵机详情


示例:用按键控制舵机

从 https://gitee.com/billyzh/esp32-cpp-lesson 下载本教程的源码到本地硬盘文件夹,如d:\esp32-cpp-lesson
在VSCode中,选择【文件】->【打开文件夹...】选择上一步保存的文件夹打开

打开项目后,选择config.h文件,修改第10行为
#define APP_LESSON52 1

打开unit5-lesson52/board_config文件,设置器件使用的引脚,
#define MANUAL_BUTTON_PIN GPIO_NUM_39
#define SG90_PIN GPIO_NUM_14
配置启用舵机
#define CONFIG_USE_SERVO 1

创建驱动器件实例,代码如下(unit5-lesson52/my_board.cpp):

MyBoard::MyBoard() : Board() {
    Log::Info(TAG, "===== Create Board ...... =====");

    Log::Info(TAG, "initial led.");
    led_ = new GpioLed(BUILTIN_LED_PIN, false);

    // 创建按键对象
    std::shared_ptrbutton = std::make_shared(kManualButton, MANUAL_BUTTON_PIN, true, false);
    button->BindAction(ButtonAction::Click);
    button->BindAction(ButtonAction::DoubleClick);
    AddButton(button);

    // 创建执行器件对象
    std::shared_ptrservo_ptr = std::make_shared(SG90_PIN);
    AddActuator(kSG90, servo_ptr);

    Log::Info( TAG, "===== Board config completed. =====");
}

程序解读
1. 创建一个按钮Button类实例,绑定单击(Click)、双击(DoubleClick)动作;
2. 创建一个舵机驱动器实例,这里使用内置的舵机驱动类ServoDriver;

舵机驱动器类ServoDriver,代码如下(src/framework/peripheral/servo_driver.h):

class ServoDriver : public Actuator {
public:
    ServoDriver(gpio_num_t pin, uint16_t max_angle=180) 
            : servo_pin_(pin), max_angle_(180) { 
        servo_ = new Servo();
        servo_->attach(servo_pin_);
    }

    virtual ~ServoDriver() { 
        servo_->detach();
    };

    void SetAngle(uint16_t angle) {
        if (angle > max_angle_) {
            angle = max_angle_;
        }
        servo_->write(angle);
    }

    uint16_t GetAngle() {
        return servo_->read();
    }

    void Reset() {
        servo_->write(max_angle_ / 2); // 归位
    }

    void Move(uint16_t angle) {
        uint16_t new_angle = servo_->read() + angle;
        if (new_angle < 0) new_angle = 0; if (new_angle > max_angle_) new_angle = max_angle_;
        servo_->write(new_angle); 
    }

private:
    Servo *servo_;
    const gpio_num_t servo_pin_;
    const uint16_t max_angle_;
};

ServoDriver类继承自Actuator类,封装了三方库ESP32Servo,提供复位(Reset)、绝对角度(SetAngle)、相对角度(Move)等方法。

控制舵机

舵机控制代码如下(unit5-lesson51/my_application.cpp):

void MyApplication::OnInit() {
    std::shared_ptr<Actuator> act_ptr = Board::GetInstance().GetActuator(kSG90);
    std::shared_ptr<ServoDriver> servo_ptr = std::static_pointer_cast<ServoDriver>(act_ptr);
    servo_ptr->Reset();
}

void MyApplication::OnLoop() {
    MyBoard *board = static_cast<myboard*>(&Board::GetInstance());
    board->ButtonTick();
    
    delay(1);
}

bool MyApplication::OnPhysicalButtonEvent(const std::string& button_name, const ButtonAction action) {
    if (button_name == kManualButton) {
        if (action == ButtonAction::Click) {
            StepMove(5);
            return true;

        } else if (action == ButtonAction::DoubleClick) {
            StepMove(-5);
            return true;
        }
    }

    return Application::OnPhysicalButtonEvent(button_name, action);
}

void MyApplication::StepMove(int step) {
    std::shared_ptr<Actuator> act_ptr = Board::GetInstance().GetActuator(kSG90);
    std::shared_ptr<ServoDriver> servo_ptr = std::static_pointer_cast<ServoDriver>(act_ptr);
    Schedule([servo_ptr, step](){
        servo_ptr->Move(step);
    });
}

程序解读
1. 在OnInit方法中调用舵机驱动类的Reset方法进行复位;
2. 在OnLoop方法中调用MyBoard的ButtonTick事件,以捕捉按键动作;
3. 重载Application类的OnPhysicalButtonEvent方法响应按键动作,本程序设计为单击向右5度,双击向左5度;
4. StepMove方法中调用舵机驱动类的Move方法进行移动,这里调用Schedule方法来调度Move方法,保障多次调用可以顺序执行;

此处使用static_pointer_cast来进行智能指针的向下强制转换(父类指针转为子类指针),若指针与预期类型不符,返回空指针。

编译项目并上传开发板检验

作业:
实现一个自定义的执行器类。

- 本文由用户 老张 发布,文中观点仅代表作者本人,不代表本站立场。
- 如需转载,请联系作者;如有侵权,请联系本站处理。

02-04   阅读(130)   评论(0)
 标签: 创客电子 ESP32 舵机 ESP32-ArduinoFx

涨知识
舵机

舵机是一种位置(角度)伺服的驱动器,适用于那些需要角度不断变化并可以保持的控制系统。在高档遥控玩具,如飞机、潜艇模型,遥控机器人中已经得到了普遍应用。

评论:
相关文章
【ESP32 C++教程】Unit7-3:TFT-LCD显示屏

本节主要讲解TFT-LCD显示屏的使用和Window派生类与TFT_eSPI库的使用。


基于STEAM教育和设计思维的初中化学跨学科实践活动——基于血氧指标控制的简易供氧器设计与制作

这篇文章展示了如何将化学与工程、信息技术、现代制造技术紧密结合,以“血氧指标控制的简易供氧器”为载体,组织一次真实的跨学科项目。设计中突出“从需求出发”“闭环控制”“可视化反馈”,不仅呼应了新课标中“跨学科实践”的要求,更贴近生活实际需求,尤其适用于对科技应用、健康关怀有兴趣的学生群体,可作为项目式学习或社团活动的优质课例。


【ESP32 C++教程】Unit7-2:OLED显示屏

本节主要讲解OLED显示屏的使用和Display类及派生类的介绍及使用。


【ESP32 C++教程】Unit7-1:四位7段式数码管

本节主要讲解用TM1650来驱动四位7段式数码管模块的显示使用。


【ESP32 C++教程】Unit6-4:资源互斥访问

本节主要讲解FreeRTOS任务间如何使用互斥对象来实现资源互斥访问。


ESP32 Guru Meditation Error报错定位分析

在ESP32的开发,经常会有系统崩溃一直重启的情况,那么如何快速定位出现异常的代码呢?


【ESP32 C++教程】Unit6-3 FreeRTOS任务间通信

本节主要讲解FreeRTOS任务间如何使用消息队列、事件组和二进制信号量进行通信。


【ESP32 C++教程】Unit6-2 FreeRTOS多任务

本节主要讲解Task类,FreeRTOS多任务的使用。


【ESP32 C++教程】Unit6-1 定时器

本节主要讲解Timer类,FreeRTOS定时器的使用。


【ESP32 C++教程】Unit5-1 执行器件之继电器

本节主要讲解执行器件类型和用按键控制继电器。