找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 5048|回復: 0
收起左側(cè)

Arduino氣泵機械臂控制程序

[復制鏈接]
ID:685224 發(fā)表于 2020-1-12 09:00 | 顯示全部樓層 |閱讀模式
  1. #include <Servo.h>

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

  9. //創(chuàng)建一個舵機控制對象  

  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：左偏轉(zhuǎn)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：吸氣結(jié)束                          



  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：機械臂右轉(zhuǎn)至于初始位置右側(cè)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.   //放氣結(jié)束

  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, 下載次數(shù): 15, 下載積分: 黑幣 -5

程序
回復

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規(guī)則

手機版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機教程網(wǎng)

快速回復 返回頂部 返回列表