組込みシステムのモーション制御や位置検出機能をC++で実装

#include <iostream>

int main()
{
    // 初始化控制引脚
    int controlPin1 = 5;
    int controlPin2 = 6;

    // 初始化PWM输出引脚
    int pwmPin = 9;

    // 设置引脚为输出模式
    pinMode(controlPin1, OUTPUT);
    pinMode(controlPin2, OUTPUT);
    pinMode(pwmPin, OUTPUT);

    // 设置电机转动方向（此处假设顺时针为正转）
    digitalWrite(controlPin1, HIGH);
    digitalWrite(controlPin2, LOW);

    // 设置PWM输出占空比
    analogWrite(pwmPin, 255);

    // 停留一段时间后停止电机转动
    delay(5000);

    // 停止电机转动
    digitalWrite(pwmPin, LOW);

    return 0;
}

#include <iostream>

int main()
{
    // 初始化编码器引脚
    int encoderPinA = 2;
    int encoderPinB = 3;
  
    // 设置引脚为输入模式
    pinMode(encoderPinA, INPUT);
    pinMode(encoderPinB, INPUT);
  
    // 初始化变量记录编码器状态
    int lastEncoderA = LOW;
    int currentEncoderA = LOW;
  
    long position = 0; // 记录位置
  
    while(1)
    {
        // 读取编码器A相引脚的状态
        currentEncoderA = digitalRead(encoderPinA);
   
        // 检测A相引脚的状态变化
        if(currentEncoderA != lastEncoderA)
        {
            // 如果A相引脚变为高电平，则检测B相引脚的状态
            if(currentEncoderA == HIGH && digitalRead(encoderPinB) == LOW)
            {
                position++;
            }
            // 如果A相引脚变为低电平，则检测B相引脚的状态
            else if(currentEncoderA == LOW && digitalRead(encoderPinB) == HIGH)
            {
                position--;
            }
        }
    
        lastEncoderA = currentEncoderA;
    
        // 每隔一段时间打印位置信息
        delay(100);
        std::cout<<"Current position: "<<position<<std::endl;
    }

    return 0;
}