- const int PIN_MOTOR1_L = 0;
- const int PIN_MOTOR1_R = 1;
- const int PIN_MOTOR1_S = 2;
- void setup() {
- Serial.begin(9600);
- // 电驱
- pinMode(PIN_MOTOR1_L, OUTPUT);
- pinMode(PIN_MOTOR1_R, OUTPUT);
- pinMode(PIN_MOTOR1_S, OUTPUT);
- }
- void loop () {
- // 正转
- analogWrite(PIN_MOTOR1_R, 50);
- analogWrite(PIN_MOTOR1_L, LOW);
- digitalWrite(PIN_MOTOR1_S, HIGH);
- // 停
- digitalWrite(PIN_MOTOR1_S, LOW);
- // 反转
- analogWrite(PIN_MOTOR1_R, LOW);
- analogWrite(PIN_MOTOR1_L, 50);
- digitalWrite(PIN_MOTOR1_S, HIGH);
- // 停
- digitalWrite(PIN_MOTOR1_S, LOW);
- }
复制代码 |