久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 6554|回復: 4
打印 上一主題 下一主題
收起左側

基于51單片機的手機控制小車和機械臂程序

[復制鏈接]
跳轉到指定樓層
樓主
ID:621334 發表于 2019-10-10 22:50 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
第一寫帖子，不好的地方請大家指出
最近做了一輛小車，
具體功能如下：1、4個電機和兩個驅動模塊實現小車的運動
                      2、用藍牙模塊實現小車的通信問題，實現小車與手機的通信
                      3、機械臂的應用，用舵機實現機械臂的左右前后移動和夾東西（后來因為舵機的扭矩太小，失敗了）
                      4 、用時鐘配置pwm來控制小車速度
遇到的問題：1、藍牙模塊與手機的通信問題，解決：先要設置波特率，發送的信號是以16進制來發送的，安卓手機下載個串口助手
                    2、舵機的控制問題 ：安裝時，沒有把舵機的方向調好  心得：在機械臂組裝時，應把舵機轉向正確的角度

單片機源程序如下:
  1. #include <reg52.h>
  2. #include <intrins.h>   
  3. #define uchar unsignrd char
  4. #define uint unsigned int
  5. unsigned char a,aa,b,c,d ;
  6. uint t , count ,num;
  7. sbit   BIN1=P0^4;    //后右端電機輸入口       奇數等于1，為往前走
  8. sbit   BIN2=P0^5;
  9. sbit   BIN3=P0^6;    //后左端電機輸入口
  10. sbit   BIN4=P0^7;

  12. sbit   FIN1=P0^0;    //前右端電機輸入口
  13. sbit   FIN2=P0^1;
  14. sbit   FIN3=P0^2;    //前左端電機輸入口
  15. sbit   FIN4=P0^3;

  17. sbit   bi = P1^0;     //蜂鳴器

  19. sbit   p11 = P1^1;     //抓手舵機
  20. sbit   p12 = P1^2;     //前后伸長舵機
  21. sbit   p13 = P1^3;     //上下移動舵機
  22. sbit   p14 = P1^4;     //底層旋轉舵機

  24. sbit P14=P1^3;//尋跡左
  25. sbit P15=P1^2;//尋跡中
  26. sbit P16=P1^1;//尋跡右   

  28. void delay_us(uint z)
  29. {
  30.     uint j,k;
  31.   for(j=z;j>0;j--)
  32.     for(k=110;k>0;k--);
  33. }

  35. void delay_ms(uint q)
  36. {
  37.     uint j,k;
  38.   for(j=q;j>0;j--)
  39.     for(k=10;k>0;k--);
  40. }

  42. /*****************小車前進*****************/
  43. void forward()
  44. {   
  45.   if(num<=t)
  46.   {
  47.   BIN3=1;
  48.   BIN1=1;
  49.   FIN3=1;
  50.    FIN1=1;
  51.   }
  52.    
  53.    else
  54.   {BIN3=0;
  55.   BIN1=0;
  56.   FIN3=0;
  57.    FIN1=0;}
  58.    
  59. }

  61. /*****************小車后退*****************/
  62. void back()
  63. {   
  64.   if (num<=t)
  65.   {FIN2=1;
  66.    FIN4=1;  
  67.    BIN2=1;   
  68.    BIN4=1;
  69.   }
  70.   else
  71.    {
  72.    BIN2=0;  
  73.   FIN2=0;
  74.   BIN4=0;
  75.   FIN4=0;}
  76.   }     
  77. /*****************小車右轉*****************/
  78. void right()
  79. {   

  81.   if (num<=t)
  82.   {
  83.   FIN3 = 1;
  84.   BIN3 = 1;
  85.   }   
  86.   else
  87.   {    FIN3 = 0;
  88.    BIN3 = 0;
  89.   }

  91.   if (num<=t/6)
  92.   {
  93.    FIN1 = 1;
  94.    BIN1 = 1;
  95.    }
  96.    else
  97.    {
  98.    FIN1 = 0;
  99.    BIN1 = 0;
  100.    }
  101.   }

  103. /*****************小車左轉*****************/
  104. void left()
  105. {
  106.     if (num<=t)
  107.   {
  108.   FIN1 = 1;
  109.   BIN1 = 1;
  110.   }   
  111.   else
  112.   {
  113.    FIN1 = 0;
  114.    BIN1 = 0;
  115.   }

  117.   if (num<=t/6)
  118.   {
  119.    FIN3 = 1;
  120.    BIN3 = 1;
  121.    }
  122.    else
  123.    {
  124.    FIN3 = 0;
  125.    BIN3 = 0;
  126.    }
  127.   }


  130. /*****************小車停止*****************/ void stop()
  131. {   
  132.    FIN1=0;
  133.    FIN2=0;

  135.    FIN3=0;
  136.   FIN4=0;

  138.    BIN1=0;
  139.    BIN2=0;

  141.    BIN3=0;
  142.    BIN4=0;
  143. }

  145. /*****************小車加速*****************/

  147. void speed_add()
  148. {   
  149.     if (1<=t<20)
  150.     {t = t+2;}
  151.   if (t==20)
  152.   { t = 20;}
  153.   delay_us(200);   
  154. }

  156. /*****************小車減速*****************/

  158. void speed_down()
  159. {  if (1< t <=20)
  160.     { t = t-2;}
  161.   if (t==1)
  162.   { t = 1;}
  163.   delay_us(200);
  164. }

  166. /*****************小車循跡*****************/
  167. void xunji()
  168. {     
  169.     if((P14==0&&P15==1&&P16==0)||(P14==1&&P15==1&&P16==1))   // 為零時，證明紅外
  170. 探測到黑線
  171.   { t = 15; forward();    }
  172.     if(P14==1&&P15==0&&P16==0)
  173.    { t = 10;  left(); }    if(P14==0&&P15==0&&P16==1)
  174.    { t =10; right();}
  175.   if(P14==0&&P15==0&&P16==0)
  176.    {stop();  }
  177.   }



  181. void not_catch ()          //抓手控制
  182. {
  183.   if(count <=4)           
  184.     p11=1;         
  185.   else
  186.     p11=0;
  187. }

  189. void catch()
  190. {
  191.     if(count <=2)           
  192.     p11=1;         
  193.   else
  194.     p11=0;
  195. }

  197. void arm_forward()
  198. {
  199.   if (a == 0x46)
  200.   {
  201.     delay_ms(2);
  202.     if(a == 0x45 && b<4)
  203.     {  
  204.       b=b+1;
  205.     }   
  206.   }
  207.   if (a==0x47)
  208.   {
  209.     delay_ms(2);
  210.     if(a == 0x45 && b>0)
  211.     {  
  212.       b=b-1;
  213.     }   
  214.   }  
  215.   if(count <=b)        
  216.     p12=1;   else
  217.     p12=0;  
  218. }

  220. void arm_turn()
  221. {
  222.   
  223.   if (a == 0x46)
  224.    {
  225.     delay_ms(2);
  226.     if (c<4&&a==0x45)
  227.       {c++;}
  228.                }
  229.   if (a== 0x47)
  230.     {
  231.     delay_ms(2);
  232.     if (c>0&&a==0x45)
  233.       {c--; }
  234.           }
  235.    if(count <=c)           
  236.     p14=1;         
  237.   else
  238.     p14=0;

  240. }




  245. void arm_up()
  246. {   
  247.   if (a == 0x46)
  248.   {
  249.     delay_ms(2);
  250.     if(a == 0x45 && d<4)
  251.     {  
  252.       d=d+1;
  253.     }   
  254.   }
  255.   if (a==0x47)
  256.   {
  257.     delay_ms(2);
  258.     if(a == 0x45 && d>0)
  259.     {        d=d-1;
  260.     }   
  261.   }  
  262.   if(count <=d)        
  263.     p13=1;
  264.   else
  265.     p13=0;  
  266. }

  268. void keep()
  269. {   
  270.   not_catch();   
  271.   if(count <=d)        
  272.     p13=1;
  273.   else  
  274.     p13 = 1;     
  275.   if(count <=c)           
  276.     p14=1;
  277.   else  
  278.     p14 = 1;         
  279.   if(count <=b)        
  280.     p12=1;   
  281.   else
  282.     p12=0;
  283. }

  285. void choose_second()
  286. {   
  287.   while(a != 0x61)       //退出
  288.   {   
  289.   if (a != 0x60)
  290.   {
  291.   keep();
  292.   }
  293.      
  294.    switch(a)
  295.    {
  296.        case 0x41:                 //機械臂前進與后退        
  297. //待修改
  298.                {
  299.             while (a!=0x50)            
  300.              {arm_forward();
  301.               // not_catch();  
  302.             keep();        }
  303.             break;
  304.             }
  305.                                     
  306.            case 0x43 :                //底盤左轉與右轉  
  307.                 {
  308.             while (a!=0x50)              
  309.             {arm_turn();
  310.             //not_catch();
  311.             keep();
  312.             }  
  313.             break;}
  314.                   
  315.            case 0x62:                  //關抓手
  316.                {not_catch();   
  317.             break;}

  319.        case 0x60:                //開抓手
  320.             {
  321.            catch();
  322.            keep();
  323.            break;
  324.           }

  326.        case 0x44:                        //向上與向下
  327.              {   
  328.            while (a!=0x50)  
  329.             {arm_up();
  330.             //not_catch();
  331.             keep();
  332.                 }  
  333.                   break; }                           
  334.    }
  335.    
  336.    
  337.   }


  340. }
  341. /*****************藍牙初始化*****************/
  342. void UART_INIT()
  343. {     
  344.     TMOD |= 0x20;   //8位自動重裝模式
  345.     PCON = 0x00;         TH1 = 0xfd;
  346.         TL1 = 0xfd;   //9600波特率

  348.         SM0 = 0;
  349.         SM1 = 1;     //串口工作方式1
  350.         REN = 1;     //允許串口接收
  351.     RI = 0;  
  352.         EA = 1;      //開總中斷
  353.         ES = 1;      //開串口中斷
  354.         TR1 = 1;    //啟動定時器1   
  355. }
  356. void init()
  357. {   
  358.     num=0;
  359.     count =0;          //給 num 賦初值
  360.     TMOD |= 0X01;
  361.     TH0=(65536-458)/256;   //調整 t的值改變頻率 50HZ
  362.     TL0=(65536-458)%256;

  364.     EA=1;     
  365.     ET0=1;                     
  366.     TR0=1;

  368. }

  370. void chooce()
  371. {    t = 4;
  372.     P0 = 0x00;
  373.      aa = 1;
  374.     b =0;
  375.     c = 0;
  376.     d = 0;
  377.        while(1)
  378.     {
  379.       keep();              
  380.          switch(a)
  381.          {
  382.            case 0x41:                 //前進        //待修改
  383.                {forward();
  384.             break;}      
  385.            case 0x42:                //后退              
  386.            {back();  
  387.             break;}      
  388.            case 0x43 :                //左轉                  {left();        
  389.              break;}      
  390.            case 0x44:                 //右轉
  391.                {right();  
  392.             break;}      
  393.            case 0x45:                  //停止
  394.                {stop();   
  395.             break;}
  396.        case 0x46:                        //加速
  397.              {speed_add();
  398.                   break; }                 
  399.        case 0x47:                 //減速
  400.               {speed_down();         
  401.                break;}
  402. //       case 0x48:  {break;}            //空情況
  403.                
  404.        case 0x49 :                 //蜂鳴器振動
  405.                   { bi  =0;  
  406.               break;}
  407.      
  408.        case 0x50:                 //小車循跡
  409.                   { xunji();   
  410.               break;}  
  411.        case 0x51:   
  412.               {bi = 1;
  413.              break;}
  414.        case 0x52:
  415.             {  choose_second();
  416.             break;
  417.             }
  418.                              
  419.                                     
  420. }

  422. }
  423. }

  425. /*****************主程序*****************/
  426. void main()
  427. {     
  428.     init();
  429.         UART_INIT();     //串口初始化
  430.       chooce();     //手機控制選擇運動
  431. }  

  433. /*****************串口中斷*****************/
  434. void UART_SER() interrupt 4
  435. {
  436.     a = SBUF;
  437.     RI = 0;     //清除接收標志
  438. //    SBUF = a;    //將內容返回到手機端，可在手機查看發送內容
  439. //    while(!TI);
  440.     TI = 0;       //寫標志清零
  441. }


  444. void time0() interrupt 1 //中斷函數
  445. {
  446.   TH0=(65536-458)/256;
  447.   TL0=(65536-458)%256;

  449.   count ++;
  450.   if (count%2 == 0)
  451.   {num ++;}

  453.   if(num>21)
  454.   {   count = 0;
  455.     num=0;  
  456.   }   
  457. }  
復制代碼
程序打包:
控制小車和機械臂程序.pdf (202.28 KB, 下載次數: 57)

評分

參與人數 1黑幣 +50 收起 理由
admin + 50 共享資料的黑幣獎勵！

查看全部評分

分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏1 分享淘帖 頂頂 踩踩
回復

使用道具 舉報

沙發
ID:328014 發表于 2019-10-10 22:59 | 只看該作者
好東東啊 有原理圖嗎?
回復

使用道具 舉報

板凳
ID:621334 發表于 2019-10-10 23:04 | 只看該作者
51hei團團 發表于 2019-10-10 22:59
好東東啊 有原理圖嗎?

過幾天加上，還沒完善這一部分
回復

使用道具 舉報

地板
ID:735007 發表于 2020-4-22 10:56 | 只看該作者
晨晨晨晨晨晨 發表于 2019-10-10 23:04
過幾天加上，還沒完善這一部分

樓主，請問有原理圖嗎？
回復

使用道具 舉報

5#
ID:721592 發表于 2020-5-25 03:15 | 只看該作者
感謝分享
回復

使用道具 舉報

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

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 午夜激情视频在线 | 精品一区二区三区免费视频 | 日韩欧美三区 | 日韩视频精品在线 | 中文字幕久久精品 | 免费黄色录像片 | 爱草视频 | 国产精品91网站 | 国产夜恋视频在线观看 | 成年人在线视频 | 国产成人精品一区二区三区在线 | 国产四区| 亚洲人成人一区二区在线观看 | 欧美日韩国产在线 | 天天躁人人躁人人躁狂躁 | 在线国产一区 | 日本色高清 | 在线婷婷 | 欧美男人天堂 | 成人在线免费视频 | 97日日碰人人模人人澡分享吧 | 一区二区三区av | 亚洲国产成人精品女人久久久野战 | 欧美一区二区三区在线观看 | 日韩区 | 成人久久视频 | 精品日韩欧美一区二区 | 欧美黄色片 | 九九热免费观看 | 精品视频在线观看 | 成人免费视频在线观看 | 国产精品伦一区二区三级视频 | 国产激情免费视频 | 国产污视频在线 | 亚洲一区不卡 | 毛片一区二区三区 | 欧美国产日韩在线观看 | 激情小说综合网 | 人人干免费 | 亚洲一区二区免费视频 | 久久久久久久亚洲精品 |