【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   阅读(1)   评论(0)
 标签: 创客 ESP32 舵机

涨知识
传感器

传感器是一种检测装置,能感受到被测量的信息,并按一定规律变换成为电信号或其他所需形式的信息输出,以满足信息的传输、处理、存储、显示、记录和控制等要求。

评论:
相关文章
【ESP32 C++教程】Unit5-1 执行器件之继电器

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


【ESP32 C++教程】Unit4-3 红外接收和遥控

本小节主要讲解红外接收和遥控器件,以及遥控操作LED。


【ESP32 C++教程】Unit4-2 模拟量传感器

本小节讲解模拟量传感器使用,旋转电位器,DHT11温湿度传感器和实现自定义传感器类。


【ESP32 C++教程】Unit4-1 数字量传感器

本小节讲解Sensor类及派生类、数字量传感器使用和传感器的推荐交互流程。


【ESP32 C++教程】Unit3-2 触摸输入

本小节讲解ESP32内置触摸引脚的用法,


【ESP32 C++教程】Unit3-1 按键输入

本小节主要介绍按键信号转换、Button类及派生类、和Button交互推荐流程。


【ESP32 C++教程】Unit2-2 Ws2812灯珠

本小节主要介绍Ws2812灯珠的使用、对父类进行扩展实现自定义功能,和指针向下强制转换的使用。


【ESP32 C++教程】Unit2-1 RGB三色LED

本小节主要介绍RGB三色LED的使用,以及多态的具体实现。


【ESP32 C++教程】Unit1-3 ESP32 Arduino 开发框架

ESP32 Arduino Framework是专门针对ESP32开发板的Arduino应用开发框架,为用户开发IOT应用、HMI应用提供一致的开发体验。


ESPConnect:基于浏览器的ESP32管理器

ESPConnect是一个基于现代浏览器的管理器,在你需要快速验证、调试、管理文件、检查状态的时候,它能帮你省下大量打开和切换重型工具的时间。