欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

標題: Arduino氣泵機械臂控制程序 [打印本頁]
作者: xxykz    時間: 2020-1-12 09:00
標題: Arduino氣泵機械臂控制程序
  1. #include <Servo.h>

  3. Servo myservo0;
  4. Servo myservo1;
  5. Servo myservo2;
  6. Servo myservo3;
  7. Servo myservo4;

  9. //創建一個舵機控制對象  

  11. // 該變量用與存儲舵機角度位置  

  13. void setup()
  14. {
  15.   myservo0.attach(2);//左右，對應機械臂下舵機
  16.   myservo1.attach(3);//控制上下，對應機械臂右舵機
  17.   myservo2.attach(4);//前后控制，對應機械臂左舵機
  18.   myservo3.attach(5);//氣泵
  19.   myservo4.attach(6);//氣泵

  21.   myservo0.write(90);  
  22.   myservo1.write(90);
  23.   myservo2.write(90);  
  24.   myservo3.write(0);  
  25.   myservo4.write(0); //初始化   

  27. // 該舵機由arduino第2，3，4，5，6腳控制  
  28. }

  30. void loop()
  31. {

  33.   myservo0.write(90);//左右  
  34.   myservo1.write(90);//控制上下
  35.   myservo2.write(90);//前后控制  
  36.   myservo3.write(0);  
  37.   myservo4.write(0);   
  38.   delay(1500);
  39.   //動作1：初始化  

  41.   myservo0.write(150);//左右  
  42.   myservo1.write(90);//控制上下
  43.   myservo2.write(90);//前后控制  
  44.   myservo3.write(0);  
  45.   myservo4.write(0);   
  46.   delay(1500);                           
  47.   //動作2：左偏轉60度

  49.   myservo0.write(150);//左右  
  50.   myservo1.write(145);//控制上下
  51.   myservo2.write(65);//前后控制  
  52.   myservo3.write(0);  
  53.   myservo4.write(0);   
  54.   delay(1500);                           
  55.   //動作3：氣泵臂下放貼近物體

  57.   myservo0.write(150);//左右  
  58.   myservo1.write(145);//控制上下
  59.   myservo2.write(65);//前后控制   
  60.   myservo3.write(180);  
  61.   myservo4.write(0);   
  62.   delay(1500);
  63.   //動作4：氣泵開始吸氣                          


  66.   myservo0.write(150);//左右  
  67.   myservo1.write(145);//控制上下
  68.   myservo2.write(65);//前后控制  
  69.   myservo3.write(0);  
  70.   myservo4.write(0);   
  71.   delay(500);
  72.   //動作5：吸氣結束                          



  76.   myservo0.write(150);//左右  
  77.   myservo1.write(90);//控制上下
  78.   myservo2.write(90);//前后控制  
  79.   myservo3.write(0);  
  80.   myservo4.write(0);   
  81.   delay(1500);                           
  82.   //動作6：提升重物

  84.   myservo0.write(30);//左右  
  85.   myservo1.write(90);//控制上下
  86.   myservo2.write(90);//前后控制  
  87.   myservo3.write(0);  
  88.   myservo4.write(0);   
  89.   delay(1500);
  90.   //動作7：機械臂右轉至于初始位置右側60度。相對于30度                           

  92.   myservo0.write(30);//左右  
  93.   myservo1.write(145);//控制上下
  94.   myservo2.write(65);//前后控制  
  95.   myservo3.write(0);  
  96.   myservo4.write(0);     
  97.   delay(1500);                           
  98.   //動作8：下放機械臂

  100.   myservo0.write(30);//左右   
  101.   myservo1.write(145);//控制上下
  102.   myservo2.write(65);//前后控制  
  103.   myservo3.write(0);  
  104.   myservo4.write(180);     
  105.   delay(1500);                           
  106.   //放氣

  108.   myservo0.write(30);//左右   
  109.   myservo1.write(145);//控制上下
  110.   myservo2.write(65);//前后控制  
  111.   myservo3.write(0);  
  112.   myservo4.write(0);     
  113.   delay(1500);                           
  114.   //放氣結束

  116.   myservo0.write(30);//左右  
  117.   myservo1.write(90);//控制上下
  118.   myservo2.write(90);//前后控制   
  119.   myservo3.write(0);  
  120.   myservo4.write(0);   
  121.   delay(1500);
  122.   //提升機械臂

  124.   myservo0.write(90);  
  125.   myservo1.write(90);
  126.   myservo2.write(90);  
  127.   myservo3.write(0);  
  128.   myservo4.write(0);   
  129.   delay(15000000);
  130.   //回到初始位置
  131. }
復制代碼


氣泵機械臂控制--自己注釋.rar

704 Bytes, 下載次數: 15, 下載積分: 黑幣 -5

程序



歡迎光臨 (http://www.raoushi.com/bbs/) Powered by Discuz! X3.1