蓝牙控制机械手
本帖最后由 xmile 于 2015-4-25 15:36 编辑http://www.tudou.com/programs/view/Q6dBlYVcEOE/
用蓝牙控制的机械手
程序:
#include <Servo.h>
Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;
int r;
int h=0;
int en=4;
int state=7;
int rx=0;
int tx=1;
int l=90;
int f=90;
int u=90;
int delaytime=1000;
void setup() {
pinMode(en,OUTPUT);
pinMode(state,INPUT);
pinMode(rx,INPUT);
pinMode(tx,OUTPUT);
servo1.attach(3);
servo1.write(179);
delay(500);
servo2.attach(6);
servo2.write(90);
delay(500);
servo3.attach(9);
servo3.write(90);
delay(500);
servo4.attach(11);
servo4.write(90);
delay(500);
digitalWrite(en,HIGH);
Serial.begin(9600);
}
void loop() {
r=Serial.read();
if(r!=-1){
h=r;
}
switch(h)
{
case 99:
servo1.write(135);
delay(delaytime);
break;
case 110:
servo1.write(179);
delay(delaytime);
break;
case 108:
l+=15;
if(l>164)l=164;
servo2.write(l);
delay(delaytime);
break;
case 114:
l-=15;
if(l<15)l=15;
servo2.write(l);
delay(delaytime);
break;
case 117:
u+=15;
if(u>164)u=164;
servo3.write(u);
delay(delaytime);
break;
case 100:
u-=15;
if(u<15)u=15;
servo3.write(u);
delay(delaytime);
break;
case 102:
f+=15;
if(f>164)f=164;
servo4.write(f);
delay(delaytime);
break;
case 98:
f-=15;
if(f<15)f=15;
servo4.write(f);
delay(delaytime);
break;
case 0:
delay(delaytime);
}
}
程序更新了,不过还是不够好,不知道是左右转动的舵机质量太差还是它负载太重
楼主好像很牛逼的样子哦 {:soso_e179:} wali20150301 发表于 2015-4-24 16:30
楼主好像很牛逼的样子哦
其实这个程序还可以改的更好 楼主,你这个APP是用app-inventor写的吗? dmfylb 发表于 2015-4-29 17:06
楼主,你这个APP是用app-inventor写的吗?
app是蓝牙串口,视频里的是我改用键盘输入而已 可惜不能实时控制舵机转动,按下按键舵机会不停的转动,或者用滑动条控制,现在我在这块遇到了瓶颈。 楼主的机械手 零部件 是在哪里买的?? nill 发表于 2015-7-16 13:18
楼主的机械手 零部件 是在哪里买的??
https://item.taobao.com/item.htm?spm=a1z09.2.9.255.RI8wwd&id=41825890307&_u=m1fjurb85e13 xmile 发表于 2015-7-22 19:55
https://item.taobao.com/item.htm?spm=a1z09.2.9.255.RI8wwd&id=41825890307&_u=m1fjurb85e13
3q。。。。。。。。。。 楼主能分享一下手机APP吗?