福州布衣 发表于 2019-12-4 20:26:23

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 JDQ14                      //激光头继电器
#define LED15                     //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);
//
}
视频:
https://pan.baidu.com/s/1ZNMAWgY9JFcrpeQIVO6CMw


onereal 发表于 2020-1-16 22:48:19

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

福州布衣 发表于 2020-1-17 15:33:42

视视连接
页: [1]
查看完整版本: DIY Arduino X-Y平面画图机