掌控板遥控小车

/*!
 * MindPlus
 * mpython
 *
 */
#include <MPython.h>
#include <IOBOX_Motor.h>
#include <DFRobot_ESP32_Radio.h>

// 动态变量
volatile float mind_n_Whether_to_start_or_not;
// 函数声明
void onRadioReceive_0();
void onRadioReceive(String message);
// 创建对象
DFRobot_ESP32Radio Radio;
IOBOX_Motor        motor_ib;


// 主程序开始
void setup() {
        Radio.setCallback("OK", onRadioReceive_0);
        mPython.begin();
        Radio.setCallback(onRadioReceive);
        display.fillScreen(0);
        mind_n_Whether_to_start_or_not = 0;
        Radio.turnOn();
        Radio.setGroup(1);
        Radio.send("GO");
}
void loop() {

}

// 事件回调函数
void onRadioReceive_0() {
        mind_n_Whether_to_start_or_not = 1;
        display.setCursorLine(1);
        display.printLine("待命中...");
        display.setCursorLine(2);
        display.printLine("随时准备出发");
}
void onRadioReceive(String message) {
        display.fillScreen(1);
        if ((mind_n_Whether_to_start_or_not==1)) {
                if (((String(message).length())==2)) {
                        // 左转
                        motor_ib.motorRun(motor_ib.M1, motor_ib.CW, 200);
                        motor_ib.motorRun(motor_ib.M2, motor_ib.CW, 140);
                }
                if (((String(message).length())==3)) {
                        // 右转
                        motor_ib.motorRun(motor_ib.M2, motor_ib.CW, 200);
                        motor_ib.motorRun(motor_ib.M1, motor_ib.CW, 140);
                }
                if (((String(message).length())==1)) {
                        motor_ib.motorRun(motor_ib.M2, motor_ib.CW, 255);
                        motor_ib.motorRun(motor_ib.M1, motor_ib.CW, 255);
                }
        }
}
复制代码