基于32的智能吸油烟机系统怎么控制电机？

#include <stdio.h>

// 定义输入和输出引脚
#define MOTOR_PIN_1 2
#define MOTOR_PIN_2 3
#define MOTOR_PIN_3 4
#define LOW_GEAR_PIN 5
#define MEDIUM_GEAR_PIN 6
#define HIGH_GEAR_PIN 7

// 定义档位参数
#define LOW_GEAR 1
#define MEDIUM_GEAR 2
#define HIGH_GEAR 3

// 初始化引脚和档位变量
void setup() {
  pinMode(MOTOR_PIN_1, OUTPUT);
  pinMode(MOTOR_PIN_2, OUTPUT);
  pinMode(MOTOR_PIN_3, OUTPUT);
  pinMode(LOW_GEAR_PIN, INPUT);
  pinMode(MEDIUM_GEAR_PIN, INPUT);
  pinMode(HIGH_GEAR_PIN, INPUT);
}

// 控制电机档位的函数
void controlMotor(int gear) {
  switch (gear) {
    case LOW_GEAR:
      digitalWrite(MOTOR_PIN_1, HIGH);
      digitalWrite(MOTOR_PIN_2, LOW);
      digitalWrite(MOTOR_PIN_3, LOW);
      break;
    case MEDIUM_GEAR:
      digitalWrite(MOTOR_PIN_1, LOW);
      digitalWrite(MOTOR_PIN_2, HIGH);
      digitalWrite(MOTOR_PIN_3, LOW);
      break;
    case HIGH_GEAR:
      digitalWrite(MOTOR_PIN_1, LOW);
      digitalWrite(MOTOR_PIN_2, LOW);
      digitalWrite(MOTOR_PIN_3, HIGH);
      break;
    default:
      digitalWrite(MOTOR_PIN_1, LOW);
      digitalWrite(MOTOR_PIN_2, LOW);
      digitalWrite(MOTOR_PIN_3, LOW);
      break;
  }
}

void loop() {
  // 通过按键输入控制档位
  if (digitalRead(LOW_GEAR_PIN) == HIGH) {
    controlMotor(LOW_GEAR);
  } else if (digitalRead(MEDIUM_GEAR_PIN) == HIGH) {
    controlMotor(MEDIUM_GEAR);
  } else if (digitalRead(HIGH_GEAR_PIN) == HIGH) {
    controlMotor(HIGH_GEAR);
  } else {
    controlMotor(0); // 默认关闭电机
  }
}

int main() {
  setup();
  while (1) {
    loop();
  }
  return 0;
}