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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

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

數字羅盤（GY-271）的51單片機小車

[復制鏈接]
跳轉到指定樓層
樓主
ID:183949 發表于 2017-4-2 15:14 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
數字羅盤采用IIC通信，小車電機采用定時器中斷PWM波調速，但是調速功能不能出現，小車電機一直全速轉動。
網上有人說如果使用PWM調速，因為52單片機的模擬IIC與PWM沖突（尚未解決），采取的是當需要改變小車方向時，關PWM中斷及定時器。可以在操作完了重新打開。我也加了，但效果還是這樣。
下面是代碼：
  1. #include "reg52.h"
  2. #include "intrins.h"
  3. #include "math.h"
  4. #include "stdio.h"
  5. typedef   unsigned char u8;
  6. typedef   unsigned int  u16;
  7. #define  Data_Port P0                        //LCD1602數據端口
  8. #define        Slave_Address   0x1a        
  9. sbit        SCL=P1^7;      //IIC時鐘線
  10. sbit        SDA=P3^2;      //IIC數據線
  11. sbit    LCD_RS=P3^5;   //LCD1602命令端口               
  12. sbit    LCD_RW=P3^6;   //LCD1602命令端口               
  13. sbit    LCD_EN=P3^4;   //LCD1602使能端口
  14. sbit    LED=P1^2;
  15. sbit zea=P2^1;         //定義接口                                       
  16. sbit zIN1=P2^5;                        //轉向輪
  17. sbit zIN2=P2^2;                        //轉向輪
  18. sbit zIN3=P2^4;
  19. sbit zIN4=P2^6;
  20. sbit zeb=P2^0;
  21. sbit yea=P1^1;         //z為左邊，y為右邊                                
  22. sbit yIN1=P1^3;
  23. sbit yIN2=P1^4;
  24. sbit yIN3=P1^6;                        //轉向輪
  25. sbit yIN4=P1^5;                        //轉向輪
  26. sbit yeb=P1^2;
  27. u16 ynum1=0;               
  28. u16 znum1=0;
  29. u8 ge=0,shi=0,bai=0,qian=0,wan=0;     //顯示變量            
  30. u8 BUF[8]=0;                                                  //數據緩沖區
  31. void Delay_5us()
  32. {
  33.         _nop_();_nop_();_nop_();_nop_();
  34.         _nop_();_nop_();_nop_();_nop_();
  35.         _nop_();_nop_();_nop_();_nop_();
  36.         _nop_();_nop_();_nop_();_nop_();
  37.         _nop_();_nop_();_nop_();_nop_();
  38.         _nop_();_nop_();_nop_();_nop_();
  39.         _nop_();_nop_();_nop_();_nop_();
  40.         _nop_();_nop_();_nop_();_nop_();
  41. }
  42. void Delay_ms(u16 t)        
  43. {                                                
  44.         u16 i,j;                                
  45.         for(i=t;i>0;i--)
  46.         for(j=121;j>0;j--);                                                
  47. }


  50. /**************************************
  51. 起始信號
  52. **************************************/
  53. void QMC5883_Start()
  54. {
  55.     SDA = 1;                    //拉高數據線
  56.     SCL = 1;                    //拉高時鐘線
  57.     Delay_5us();                 //延時
  58.     SDA = 0;                    //產生下降沿
  59.     Delay_5us();                 //延時
  60.     SCL = 0;                    //拉低時鐘線
  61. }


  64. /**************************************
  65. 停止信號
  66. **************************************/
  67. void QMC5883_Stop()
  68. {
  69.     SDA = 0;                    //拉低數據線
  70.     SCL = 1;                    //拉高時鐘線
  71.     Delay_5us();                 //延時
  72.     SDA = 1;                    //產生上升沿
  73.     Delay_5us();                 //延時
  74. }


  77. /**************************************
  78. 發送應答信號
  79. 入口參數:ack (0:ACK 1:NAK)
  80. **************************************/
  81. void QMC5883_SendACK(bit ack)
  82. {
  83.     SDA = ack;                  //寫應答信號
  84.     SCL = 1;                    //拉高時鐘線
  85.     Delay_5us();                 //延時
  86.     SCL = 0;                    //拉低時鐘線
  87.     Delay_5us();                 //延時
  88. }


  91. /**************************************
  92. 接收應答信號
  93. **************************************/
  94. bit QMC5883_RecvACK()
  95. {
  96.     SCL = 1;                    //拉高時鐘線
  97.     Delay_5us();                //延時
  98.     CY = SDA;                   //進位標志 讀應答信號
  99.     SCL = 0;                    //拉低時鐘線
  100.     Delay_5us();                //延時
  101.     return CY;
  102. }


  105. /**************************************
  106. 向IIC總線發送一個字節數據
  107. **************************************/
  108. void QMC5883_SendByte(u8 dat)
  109. {
  110.     u8 i;


  113.     for (i=0; i<8; i++)         //8位計數器
  114.     {
  115.         dat <<= 1;              //移出數據的最高位
  116.         SDA = CY;               //送數據口
  117.         SCL = 1;                //拉高時鐘線
  118.         Delay_5us();             //延時
  119.         SCL = 0;                //拉低時鐘線
  120.         Delay_5us();             //延時
  121.     }
  122.     QMC5883_RecvACK();
  123. }


  126. /**************************************
  127. 從IIC總線接收一個字節數據
  128. **************************************/
  129. u8 QMC5883_RecvByte()
  130. {
  131.     u8 i;
  132.     u8 dat = 0;


  135.     SDA = 1;                    //使能內部上拉,準備讀取數據,
  136.     for (i=0; i<8; i++)         //8位計數器
  137.     {
  138.         dat <<= 1;
  139.         SCL = 1;                //拉高時鐘線
  140.         Delay_5us();             //延時
  141.         dat |= SDA;             //讀數據               
  142.         SCL = 0;                //拉低時鐘線
  143.         Delay_5us();             //延時
  144.     }
  145.     return dat;
  146. }


  149. //************************寫入單字節數據***************************


  152. void Single_Write_QMC5883(u8 REG_Address,u8 REG_data)
  153. {
  154.     QMC5883_Start();                  //起始信號
  155.     QMC5883_SendByte(Slave_Address);   //發送設備地址+寫信號
  156.     QMC5883_SendByte(REG_Address);    //內部寄存器地址，請參考中文pdf
  157.     QMC5883_SendByte(REG_data);       //內部寄存器數據，請參考中文pdf
  158.     QMC5883_Stop();                   //發送停止信號
  159. }


  162. //************************讀取單字節數據*************************
  163. //u8 Single_Read_QMC5883(u8 REG_Address)
  164. //{   
  165. //        u8 REG_data;
  166. //        QMC5883_Start();                          //起始信號
  167. //        QMC5883_SendByte(Slave_Address);           //發送設備地址+寫信號
  168. //        QMC5883_SendByte(REG_Address);            //發送存儲單元地址，從0開始        
  169. //        QMC5883_Start();                          //起始信號
  170. //        QMC5883_SendByte(Slave_Address+1);         //發送設備地址+讀信號
  171. //        REG_data=QMC5883_RecvByte();              //讀出寄存器數據
  172. //        QMC5883_SendACK(1);   
  173. //        QMC5883_Stop();                           //停止信號
  174. //  return REG_data;
  175. //}


  178. //******************************************************
  179. //連續讀出QMC5883內部角度數據，地址范圍0x00~0x05
  180. //******************************************************
  181. void Multiple_Read_QMC5883(void)
  182. {   
  183.     u8 i;
  184.     QMC5883_Start();                          //起始信號
  185.     QMC5883_SendByte(Slave_Address);          //發送設備地址+寫信號
  186.     QMC5883_SendByte(0x00);                   //發送存儲單元地址，從0x00開始        
  187.     QMC5883_Start();                          //起始信號
  188.     QMC5883_SendByte(Slave_Address+1);        //發送設備地址+讀信號
  189.          for (i=0; i<6; i++)                      //連續讀取6個地址數據，存儲中BUF
  190.     {
  191.         BUF[i] = QMC5883_RecvByte();          //BUF[0]存儲數據
  192.         if (i == 5)
  193.         {
  194.            QMC5883_SendACK(1);                //最后一個數據需要回非應答NOACK
  195.         }
  196.         else
  197.         {
  198.           QMC5883_SendACK(0);                 //應答ACK
  199.        }
  200.    }
  201.     QMC5883_Stop();                           //停止信號
  202.     Delay_ms(5);
  203. }


  206. //初始化QMC5883，根據需要請參考pdf進行修改****
  207. void Init_QMC5883()
  208. {


  211.         Single_Write_QMC5883(0x09,0x0d);  //控制寄存器配置
  212.         Single_Write_QMC5883(0x0b,0x01);  //設置清除時間寄存器
  213.         Single_Write_QMC5883(0x20,0x40);  //
  214.         Single_Write_QMC5883(0x21,0x01);  //        
  215. }


  218. /***************等待LCD使能****************/
  219. void Wait_For_Enable(void)        
  220. {                                       
  221.         Data_Port=0xff;               
  222.         LCD_RS=0;
  223.         LCD_RW=1;
  224.         _nop_();
  225.         LCD_EN=1;
  226.         _nop_();
  227.         _nop_();
  228.         while(Data_Port&0x80);        
  229.         LCD_EN=0;                                
  230. }                                       
  231. /**************寫LCD命令函數*****************/
  232. void Write_Command_LCD(u8 CMD,u8 Attribc)
  233. {                                       
  234.         if(Attribc)Wait_For_Enable();        
  235.         LCD_RS=0;
  236.         LCD_RW=0;
  237.         _nop_();
  238.         Data_Port=CMD;
  239.         _nop_();        
  240.         LCD_EN=1;
  241.         _nop_();
  242.         _nop_();
  243.         LCD_EN=0;
  244. }                                       
  245. /**************寫LCD數據寄存器*****************/
  246. void Write_Data_LCD(u8 dataW)
  247. {                                       
  248.         Wait_For_Enable();               
  249.         LCD_RS=1;
  250.         LCD_RW=0;
  251.         _nop_();
  252.         Data_Port=dataW;
  253.         _nop_();        
  254.         LCD_EN=1;
  255.         _nop_();
  256.         _nop_();
  257.         LCD_EN=0;
  258. }               
  259. /****************初始化LCD*******************/
  260. void Init_Lcd()                                
  261. {                        
  262.         Write_Command_LCD(0x38,1);        
  263.         Write_Command_LCD(0x08,1);        
  264.         Write_Command_LCD(0x01,1);        
  265.         Write_Command_LCD(0x06,1);        
  266.         Write_Command_LCD(0x0c,1);
  267. }                        
  268. /****************顯示一個字符*******************/
  269. void Display_One_Char(u8 X,u8 Y,u8 DData)
  270. {                                                
  271.         Y&=1;                                                
  272.         X&=15;                                                
  273.         if(Y)X|=0x40;                                       
  274.         X|=0x80;                        
  275.         Write_Command_LCD(X,0);               
  276.         Write_Data_LCD(DData);               
  277. }                                                




  282. //******************************顯示在LCD的數據取位********************************//
  283. void Conversion(u16 temp_data)  
  284. {  
  285.     wan=temp_data/10000+0x30 ;
  286.     temp_data=temp_data%10000;   //取余運算
  287.         qian=temp_data/1000+0x30 ;
  288.     temp_data=temp_data%1000;    //取余運算
  289.     bai=temp_data/100+0x30   ;
  290.     temp_data=temp_data%100;     //取余運算
  291.     shi=temp_data/10+0x30    ;
  292.     temp_data=temp_data%10;      //取余運算
  293.     ge=temp_data+0x30;         
  294. }




  299. void fanwei()
  300. {
  301. //        u16 i;
  302.         int x=0,y=0,z=0;
  303.         double angle=0;        
  304.     Delay_ms(200);
  305.         Init_Lcd();
  306.         Init_QMC5883();
  307.         Delay_ms(300);
  308.         Multiple_Read_QMC5883();                                      //連續讀取三軸角度數據，存儲在BUF中
  309.                 //---------顯示XY軸
  310.                 x=BUF[1] << 8 | BUF[0]; //Combine MSB and LSB of X Data output register  最高有效位
  311.                 y=BUF[3] << 8 | BUF[2]; //Combine MSB and LSB of Y Data output register
  312.                 z=BUF[5] << 8 | BUF[4]; //Combine MSB and LSB of Z Data output register
  313.                 angle= atan2((double)y,(double)x) * (180 / 3.14159265) + 180; //計算角度
  314.                 angle*=10;
  315.                 Conversion(angle);       //計算角度數據和顯示
  316.                 Display_One_Char(2,0,'A');
  317.                 Display_One_Char(3,0,':');
  318.                 Display_One_Char(4,0,qian);
  319.                 Display_One_Char(5,0,bai);
  320.                 Display_One_Char(6,0,shi);
  321.                 Display_One_Char(7,0,'.');
  322.                 Display_One_Char(8,0,ge);
  323.                 Delay_ms(100);   //延時                     
  324. }
  325. void time0_init()                        //定時器初始化
  326. {
  327.    TMOD=0x01;                                //T0工作方式1
  328.    EA=1;
  329.    ET0=1;
  330.    TR0=1;
  331.    TH0=(65536-917)/256;      //1ms 進入一次中斷
  332.    TL0=(65536-917)%256;
  333. }
  334. void time0_stop()                         //關閉中斷
  335. {  
  336.   EA=0;
  337.   ET0=0;
  338.   TR0=0;                                                        
  339.   
  340. }
  341. void chang_pwm1(u16 znum3,u16 ynum3)           //zum3,yum3為車速
  342. {      
  343.     if(znum1>znum3)
  344.              {
  345.            zea=0;
  346.            zeb=0;
  347.           }
  348.         else
  349.           {
  350.            zea=1;
  351.            zeb=1;
  352.           }
  353.         if(ynum1>ynum3)
  354.              {
  355.            yea=0;
  356.            yeb=0;
  357.           }
  358.         else
  359.           {
  360.            yea=1;
  361.            yeb=1;
  362.           }
  363.         if(znum1>50)
  364.         {
  365.            znum1=0;
  366.         }                                   
  367.         if(ynum1>50)
  368.         {
  369.            ynum1=0;
  370.         }
  371. }                  
  372. void turn_right()
  373. {      
  374.    chang_pwm1(20,10);                   //右拐               
  375. }
  376. void turn_wei()                                   //變向
  377. {     
  378.      zIN1=0;
  379.      zIN2=1;
  380.          yIN3=1;                                                
  381.      yIN4=0;
  382.          zIN3=0;                                                
  383.      zIN4=0;
  384.          yIN1=0;
  385.      yIN2=0;
  386.          chang_pwm1(10,10);                              
  387. }
  388. void go_straight()
  389. {   
  390.    chang_pwm1(10,10);                   //直行
  391. }  
  392. void init()                        //初始化
  393. {
  394.          yea=1;
  395.      yIN1=1;
  396.      yIN2=0;  
  397.      yIN3=1;                                                
  398.      yIN4=0;
  399.       yeb=1;
  400.           zea=1;         
  401.      zIN1=1;
  402.      zIN2=0;
  403.      zIN3=1;                                                
  404.      zIN4=0;
  405.       zeb=1;
  406. }        
  407. void main()
  408. {
  409.     while(1)
  410.         {
  411.            fanwei();
  412.           if((qian!='2')||((bai!='4')&&(bai!='5')))
  413.           {         
  414.                     init();
  415.                  time0_init();
  416.                  turn_wei();
  417.           }
  418.           else
  419.           {         
  420.              init();
  421.              time0_init();
  422.                  go_straight();            
  423.           }
  424.           time0_stop();        
  425.          }
  426. }
  427. void  T0_time()interrupt 1         //中斷程序1
  428. {
  429.         TH0=(65536-917)/256;      //1ms 進入一次中斷
  430.     TL0=(65536-917)%256;
  431.     znum1++;
  432.         ynum1++;            
  433. }
復制代碼
分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏 分享淘帖 頂頂 踩踩
回復

使用道具 舉報

沙發
ID:151348 發表于 2017-4-2 17:06 | 只看該作者
你試試把PWM調速部分單獨取出來，另外寫一個程序，看看能不能實現調速

評分

參與人數 1黑幣 +20 收起 理由
admin + 20 回帖助人的獎勵！

查看全部評分

回復

使用道具 舉報

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

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 色播av| 亚洲精品自在在线观看 | 中文成人在线 | 超碰在线亚洲 | 99精品久久| 久久久久国产一区二区三区四区 | 久久一区二区三区四区五区 | 亚洲高清在线视频 | 国产一区二区自拍 | 亚洲午夜视频 | 成人美女免费网站视频 | 国产午夜精品一区二区三区四区 | 久久久久久高潮国产精品视 | 欧美中文字幕 | 性一交一乱一伦视频免费观看 | 日日操夜夜操视频 | 中国黄色在线视频 | 一久久久 | 欧美极品少妇xxxxⅹ免费视频 | 国产精品爱久久久久久久 | 国产日韩亚洲欧美 | 日韩精品一区二区三区久久 | 91欧美激情一区二区三区成人 | 少妇一级淫片aaaaaaaaa | 久久99精品国产自在现线小黄鸭 | 午夜视频在线观看视频 | 亚洲视频手机在线 | 国产精品亚洲综合 | 二区精品| 国内精品久久久久久 | 精品视频在线观看 | 成人一区二区三区 | 国产精品久久av | 欧美一区二区三区视频在线 | 视频一区在线观看 | 亚洲精品日韩在线 | 欧美一区二区三区在线观看 | 日本不卡一区二区三区 | 亚洲国产精久久久久久久 | 9久久婷婷国产综合精品性色 | 欧美啊v在线观看 |