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
我支持。视频直接贴链接更好,不要嵌入 视视连接
页:
[1]