Arduino 小车简单程序

zhaoyunxibsdog

于 2024-08-21 13:16:08 发布

阅读量178

点赞数 1

文章标签：开发语言

本文链接：https://blog.csdn.net/zhaoyunxibsdog/article/details/141390946

版权

int rightMz = 11;
int rightMf = 3;
3int leftMz = 6;
int leftMf =5;
int carspeed=120; //车辆根据重量160以上才能转动起来
void setup(){
pinMode(rightMz,OUTPUT);//电机端口的管脚模式。
pinMode(rightMf,OUTPUT);//电机端口的管脚模式。
pinMode(leftMz,OUTPUT);//电机端口的管脚模式
pinMode(leftMf,OUTPUT);//电机端口的管脚模式。
carstop();
}
void loop(){
  int delayTime =2000;
  forward(carspeed);//前进
  delay(delayTime);
  backward(carspeed);//后退
  delay(delayTime);
  turnLeft(carspeed);//原地左转
  delay(delayTime);//原地右转
  turnRight(carspeed);
  delay(delayTime);
  leftC(carspeed);
  delay(delayTime);
  rightC(carspeed);
  delay(delayTime);
  carstop();
  delay(delayTime);
}
//前进
void forward(int sp){
  analogWrite(rightMz,sp);
  digitalWrite(rightmf,0);
  analogWrite(leftMz,sp);
  digitalWrite(leftMf,0);}
//后退
void backward(int sp){
  analogWrite(rightMf,sp);
  digitalWrite(rightMz,0);
  analogWrite(leftMf,sp);
  digitalWrite(leftMz,0);}
//原地左转
void turnLeft(int sp){
  analogWrite(rightMz,sp);
  digitalWrite(rightMf,0);
  analogWrite(leftMz,0);
  digitalWrite(leftMf,0);}
//原地右转
void turnRight(int sp){
  analogWrite(rightMz,0);
  digitalWrite(rightMf,0);
  analogWrite(leftMz,sp);
  digitalWrite(leftMf,0);}
//左转圈
void leftc(int sp){
  analogWrite(rightMz,sp);
  digitalWrite(rightMf,0);
  analogWrite(leftMf,sp);
  digitalWrite(leftMz,0);}
//右转圈
void rightc(int sp){
  analogWrite(rightMf,sp);
  digitalWrite(rightMz,0);
  analogWrite(leftMz,sp);
  digitalWrite(leftMf,0);}

你学会了吗？