DIY Arduino X-Y平面画图机

福州布衣

DIY Arduino X-Y平面运动机械

硬件: 1.Arduino UNO x1
2.两个舵机 x2
3.大圆齿轮 x2
4.其它塑料组件

成品图:

代码:

#include <Stepper.h>
#include <Servo.h>
Servo myservo1;  
Servo myservo2;
int pos1 =0;
int pos2 =0;
#define JDQ1  4                      //激光头继电器
#define LED1  5                       //LED灯

void setup() {
Serial.begin(9600);                   //串口
pinMode(JDQ1,OUTPUT);
pinMode(LED1,OUTPUT);
myservo1.attach(2);
myservo1.write(1);  
myservo2.attach(3);
myservo2.write(1);
}

void loop() {
//横向单动-伸展
for(pos1=1;pos1<120;pos1 +=1){
  myservo1.write(pos1);
  digitalWrite(JDQ1,LOW);
  digitalWrite(LED1,HIGH);
  delay(10);
  }
  digitalWrite(JDQ1,HIGH);
  digitalWrite(LED1,LOW);
  delay(1000);
//纵向单动-伸展
for(pos2=1;pos2<120;pos2 +=1){
  myservo2.write(pos2);
  digitalWrite(JDQ1,LOW);
  digitalWrite(LED1,HIGH);
  delay(10);
  }
  digitalWrite(JDQ1,HIGH);
  digitalWrite(LED1,LOW);
  delay(1000);
//横向单动-缩回
for(pos1=120;pos1>=1;pos1 -=1){
  myservo1.write(pos1);
  digitalWrite(JDQ1,LOW);
  digitalWrite(LED1,HIGH);
  delay(10);
  }
  digitalWrite(JDQ1,HIGH);
  digitalWrite(LED1,LOW);
  delay(1000);
//纵向单动-缩回
for(pos2=120;pos2>=1;pos2 -=1){
  myservo2.write(pos2);
  digitalWrite(JDQ1,LOW);
  digitalWrite(LED1,HIGH);
  delay(10);}
  digitalWrite(JDQ1,HIGH);
  digitalWrite(LED1,LOW);
  delay(1000);
//横向纵向联动-伸展
for(pos1=1;pos1<120;pos1 +=1){
  myservo1.write(pos1);
  myservo2.write(pos1);
  digitalWrite(JDQ1,LOW);
  digitalWrite(LED1,HIGH);
  delay(10);
  }
  digitalWrite(JDQ1,HIGH);
  digitalWrite(LED1,LOW);
  delay(1000);
//横向纵向联动-缩回
for(pos1=120;pos1>=1;pos1 -=1){
  myservo1.write(pos1);
  myservo2.write(pos1);
  digitalWrite(JDQ1,LOW);
  digitalWrite(LED1,HIGH);
  delay(10);}
  digitalWrite(JDQ1,HIGH);
  digitalWrite(LED1,LOW);
  delay(1000);
//
}
视频:

onereal

我支持。视频直接贴链接更好，不要嵌入

福州布衣

视视连接