设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › 24小时必答区 › 求解决PIC18F4520为什么不能读出MPU6050陀螺仪的数据
返回列表 发新帖
查看: 2423|回复: 1
收起左侧

求解决PIC18F4520为什么不能读出MPU6050陀螺仪的数据

[复制链接]
ID:169653 发表于 2017-9-11 15:14 | 显示全部楼层 |阅读模式
100黑币
  1. #include <p18cxxx.h>    /*18F系列单片机头文件*/
  2. #include "k18.h"        /*开发板头文件*/
  3. #include "REG.h"
  4. #define uchar    unsigned char
  5. #define uint     unsigned int
  6. #define ulong    unsigned long
  7. #define ushort   unsigned short  
  8. #define IIC_SCL  PORTCbits.RC5
  9. #define IIC_SDA  PORTCbits.RC4
  10. #define READ_SDA PORTCbits.RC4  //输入SDA
  11. #define IIC_SDA_TRIS TRISCbits.TRISC3
  12. #define SDA_IN()   1
  13. #define SDA_OUT()  0
  14. float   Angle[3];        //陀螺仪角度        
  15. float   a[3];            //陀螺仪加速度
  16. float   w[3];            //陀螺仪角速度
  17. float   h[3];                           
  18. uchar   chrTemp[22];
  19. ushort  data[3];
  20. void PIC18F_High_isr(void);  /*中断服务函数声明*/
  21. void PIC18F_Low_isr(void);

  23. #pragma code high_vector_section=0x8

  25. void high_vector (void)
  26. {
  27.         _asm goto PIC18F_High_isr _endasm   /*通过一条跳转指令(汇编指令），跳转到中断服务函数（中断服务程序）处*/
  28. }
  29. #pragma code low_vector_section=0x18
  30. void low_vector (void)
  31. {
  32.         _asm goto PIC18F_Low_isr _endasm
  33. }
  34. #pragma code

  36. #pragma interrupt PIC18F_High_isr
  37. void PIC18F_High_isr (void)
  38. {   
  39.         PIR1bits.RCIF=0;

  41. }
  42. #pragma interruptlow PIC18F_Low_isr

  44. void PIC18F_Low_isr (void)
  45. {

  47. }
  48. void Delay_us(uchar n)
  49. {
  50.     uint j,k;
  51.     for(j=0;j<n;j++)         
  52.       for(k=1;k>0;k--);
  53. }
  54. void Delay_ms(uint n)
  55. {
  56.     uint j,k;
  57.     for(j=0;j<n;j++)
  58.       for(k=730;k>0;k--);
  59. }
  60. void IIC_Init(void)
  61. {                        
  62.         
  63.         SDA_OUT();     //sda线输出
  64.         IIC_SDA=1;                    
  65.         IIC_SCL=1;
  66. }
  67. /**************************实现函数********************************************
  68. *函数原型:                void IIC_Start(void)
  69. *功　　能:                产生IIC起始信号
  70. *******************************************************************************/
  71. void IIC_Start(void)
  72. {
  73.         SDA_OUT();     //sda线输出
  74.         IIC_SDA=1;                    
  75.         IIC_SCL=1;        
  76.         Delay_us(5);
  77.          IIC_SDA=0;//START:when CLK is high,DATA change form high to low         
  78.         Delay_us(5);
  79.         IIC_SCL=0;//钳住I2C总线，准备发送或接收数据
  80. }

  82. /**************************实现函数********************************************
  83. *函数原型:                void IIC_Stop(void)
  84. *功　　能:            //产生IIC停止信号
  85. *******************************************************************************/         
  86. void IIC_Stop(void)
  87. {
  88.         SDA_OUT();//sda线输出
  89.         IIC_SCL=0;
  90.         IIC_SDA=0;//STOP:when CLK is high DATA change form low to high
  91.          
  92.         Delay_us(5);
  93.         IIC_SCL=1;
  94.         IIC_SDA=1;//发送I2C总线结束信号
  95.         
  96.         Delay_us(5);                                                                  
  97. }

  99. /**************************实现函数********************************************
  100. *函数原型:                u8 IIC_Wait_Ack(void)
  101. *功　　能:            等待应答信号到来
  102. //返回值：1，接收应答失败
  103. //        0，接收应答成功
  104. *******************************************************************************/
  105. uchar IIC_Wait_Ack(void)
  106. {
  107.         uchar  ucErrTime=0;
  108.         SDA_IN();      //SDA设置为输入  
  109.         IIC_SDA=1;
  110.         Delay_us(5);         
  111.         while(READ_SDA)
  112.         {
  113.                 ucErrTime++;
  114.                 if(ucErrTime>50)
  115.                 {
  116.                         IIC_Stop();
  117.                         return 1;
  118.                 }
  119.                 Delay_us(5);
  120.         }  
  121.             IIC_SCL=1;
  122.             Delay_us(5);
  123.             IIC_SCL=0;//时钟输出0  
  124.             return 0;  
  125. }

  127. /**************************实现函数********************************************
  128. *函数原型:                void IIC_Ack(void)
  129. *功　　能:            产生ACK应答
  130. *******************************************************************************/
  131. void IIC_Ack(void)
  132. {
  133.         IIC_SCL=0;
  134.         SDA_OUT();
  135.         IIC_SDA=0;
  136.         Delay_us(5);
  137.         IIC_SCL=1;
  138.         Delay_us(5);
  139.         IIC_SCL=0;
  140. }
  141.         
  142. /**************************实现函数********************************************
  143. *函数原型:                void IIC_NAck(void)
  144. *功　　能:            产生NACK应答
  145. *******************************************************************************/            
  146. void IIC_NAck(void)
  147. {
  148.         IIC_SCL=0;
  149.         SDA_OUT();
  150.         IIC_SDA=1;
  151.         
  152.         Delay_us(5);
  153.         IIC_SCL=1;
  154.         Delay_us(5);
  155.         IIC_SCL=0;
  156. }                                                                              

  158. /**************************实现函数********************************************
  159. *函数原型:                void IIC_Send_Byte(u8 txd)
  160. *功　　能:            IIC发送一个字节
  161. *******************************************************************************/                  
  162. void IIC_Send_Byte(uint txd)
  163. {                        
  164.     uint t;
  165.         SDA_OUT();            
  166.     IIC_SCL=0;//拉低时钟开始数据传输
  167.     for(t=0;t<8;t++)
  168.     {              
  169.         IIC_SDA=(txd&0x80)>>7;
  170.         txd<<=1;           
  171.                         
  172.                 Delay_us(5);   
  173.                 IIC_SCL=1;
  174.                 Delay_us(5);
  175.                 IIC_SCL=0;        
  176.                 Delay_us(5);
  177.     }         
  178. }         

  180. /**************************实现函数********************************************
  181. *函数原型:                u8 IIC_Read_Byte(unsigned char ack)
  182. *功　　能:            //读1个字节，ack=1时，发送ACK，ack=0，发送nACK
  183. *******************************************************************************/  
  184. uchar  IIC_Read_Byte(uchar ack)
  185. {
  186.         uchar i,receive=0;
  187.         SDA_IN();//SDA设置为输入
  188.     for(i=0;i<8;i++ )
  189.         {
  190.         IIC_SCL=0;

  192.                 Delay_us(5);
  193.                 IIC_SCL=1;
  194.         receive<<=1;
  195.         if(READ_SDA)receive++;   
  196.                
  197.                 Delay_us(5);
  198.     }                                         
  199.     if (ack)
  200.         IIC_Ack(); //发送ACK
  201.     else
  202.         IIC_NAck();//发送nACK  
  203.     return receive;
  204. }

  206. /**************************实现函数********************************************
  207. *函数原型:                u8 IICreadBytes(u8 dev, u8 reg, u8 length, u8 *data)
  208. *功　　能:            读取指定设备 指定寄存器的 length个值
  209. 输入        dev  目标设备地址
  210.                 reg          寄存器地址
  211.                 length 要读的字节数
  212.                 *data  读出的数据将要存放的指针
  213. 返回   读出来的字节数量
  214. *******************************************************************************/
  215. ulong IICreadBytes(uchar dev, uchar reg, ulong length, ulong  *data)
  216. {
  217.     uint count = 0;
  218.         
  219.         IIC_Start();
  220.         IIC_Send_Byte(dev<<1);           //发送写命令
  221.         IIC_Wait_Ack();
  222.         IIC_Send_Byte(reg);   //发送地址
  223.     IIC_Wait_Ack();         
  224.         IIC_Start();
  225.         IIC_Send_Byte((dev<<1)+1);  //进入接收模式        
  226.         IIC_Wait_Ack();        
  227.     for(count=0;count<length;count++)
  228.             {                 
  229.                  if(count!=length-1)data[count]=IIC_Read_Byte(1);  //带ACK的读数据
  230.                  else  data[count]=IIC_Read_Byte(0);         //最后一个字节NACK
  231.             }
  232.     IIC_Stop();//产生一个停止条件
  233.     return count;
  234. }

  236. /**************************实现函数********************************************
  237. *函数原型:                u8 IICwriteBytes(u8 dev, u8 reg, u8 length, u8 *data)
  238. *功　　能:            将多个字节写入指定设备 指定寄存器
  239. 输入        dev     目标设备地址
  240.                 reg            寄存器地址
  241.                 length  要写的字节数
  242.                 *data   将要写的数据的首地址
  243. 返回   返回是否成功
  244. *******************************************************************************/
  245. ulong IICwriteBytes(uchar dev, uchar reg, ulong length, ulong  *data)
  246. {

  248.          uint count = 0;
  249.         IIC_Start();
  250.         IIC_Send_Byte(dev<<1);           //发送写命令
  251.         IIC_Wait_Ack();
  252.         IIC_Send_Byte(reg);   //发送地址
  253.         IIC_Wait_Ack();         
  254.         for(count=0;count<length;count++)
  255.       {
  256.                 IIC_Send_Byte(data[count]);
  257.                 IIC_Wait_Ack();
  258.       }
  259.         IIC_Stop();//产生一个停止条件

  261.     return 1; //status == 0;
  262.         
  263. }
  264. void ShortToChar(short sData,unsigned char cData[])
  265. {
  266.         cData[0]=sData&0xff;
  267.         cData[1]=sData>>8;
  268. }
  269. short CharToShort(unsigned char cData[])
  270. {
  271.         return ((short)cData[1]<<8)|cData[0];
  272. }
  273. void main(void)
  274. {        
  275.         k18_init();           /*K18开发板初始化*/
  276.         IIC_Init();        
  277.         RCSTAbits.SPEN = 1;   /*使能串口（将RX和TX引脚配置为串口引脚）*/
  278.         TXSTAbits.SYNC = 0;   /*异步模式*/
  279.         SPBRG = 0x47;         /*波特率寄存器置值，设置波特率38400*/
  280.         TXSTAbits.BRGH=1;  /*速度模式：高速*/
  281.         RCSTAbits.CREN=1;  /*接收使能*/
  282.         TXSTAbits.TXEN=1;  /*发送使能*/               
  283.         IPR1bits.RCIP=1;      /*设定串口接收中断为高优先级，本句也可以省略，复位后默认为高优先级*/
  284.         PIE1bits.RCIE=1;      /*串口接收中断允许*/
  285.         INTCONbits.PEIE=1;    /*外设中断允许*/
  286.         INTCONbits.GIE=1;     /*开总中断*/        
  287.         while(1)
  288.         {   
  289.                 Delay_ms(100);
  290.                 IICreadBytes(0x55, AX, 24,&chrTemp[0]);
  291.                
  292.                 //a[0] = (float)CharToShort(&chrTemp[0])/32768*16;
  293.                 //a[1] = (float)CharToShort(&chrTemp[2])/32768*16;
  294.         //        a[2] = (float)CharToShort(&chrTemp[4])/32768*16;
  295.         //        w[0] = (float)CharToShort(&chrTemp[6])/32768*2000;
  296.         //        w[1] = (float)CharToShort(&chrTemp[8])/32768*2000;
  297.         //        w[2] = (float)CharToShort(&chrTemp[10])/32768*2000;
  298.         //        h[0] = CharToShort(&chrTemp[12]);
  299.         //        h[1] = CharToShort(&chrTemp[14]);
  300.         //        h[2] = CharToShort(&chrTemp[16]);
  301.                 Angle[0] = (float)CharToShort(&chrTemp[18])/32768*180;
  302.             Angle[1] = (float)CharToShort(&chrTemp[20])/32768*180;
  303.                 Angle[2] = (float)CharToShort(&chrTemp[22])/32768*180;
  304.                

  306.         /*        IICreadBytes(0x51, AX, 24,&chrTemp[0]);
  307.                 a[0] = (float)CharToShort(&chrTemp[0])/32768*16;
  308.                 a[1] = (float)CharToShort(&chrTemp[2])/32768*16;
  309.                 a[2] = (float)CharToShort(&chrTemp[4])/32768*16;
  310.                 w[0] = (float)CharToShort(&chrTemp[6])/32768*2000;
  311.                 w[1] = (float)CharToShort(&chrTemp[8])/32768*2000;
  312.                 w[2] = (float)CharToShort(&chrTemp[10])/32768*2000;
  313.                 h[0] = CharToShort(&chrTemp[12]);
  314.                 h[1] = CharToShort(&chrTemp[14]);
  315.                 h[2] = CharToShort(&chrTemp[16]);
  316.                 Angle[0] = (float)CharToShort(&chrTemp[18])/32768*180;
  317.                 Angle[1] = (float)CharToShort(&chrTemp[20])/32768*180;
  318.                 Angle[2] = (float)CharToShort(&chrTemp[22])/32768*180;
  319.         */
  320.                  // uint i;
  321.                   //data[0]=MPU6050_I2C_ReadByte(GXH);
  322.                  // a[1]=data[1]/32768*16;
  323.                   //a[2]=data[2]/32768*16;
  324.                   //a[3]=data[3]/32768*16;
  325.               //if((data[0]=0x51)|(data[0]=0x53)|(data[0]=0x50))  //读取MPU6050的地址
  326.          //{
  327.                    //  for(i=0;i<3;i++)
  328.                    //  data[1]=(GXH<<8|GXL)/32768*180;
  329.                    //  data[2]=(GYH<<8|GYL)/32768*180;
  330.                     // data[3]=(GZH<<8|GZL)/32768*180;
  331.                    //  TXREG=data[0];
  332.                   
  333.                
  334.                //}
  335.                 /*a[0] = (float)CharToShort(&chrTemp[0])/32768*16;
  336.                 a[1] = (float)CharToShort(&chrTemp[2])/32768*16;
  337.                        a[2] = (float)CharToShort(&chrTemp[4])/32768*16;
  338.                     w[0] = (float)CharToShort(&chrTemp[6])/32768*2000;
  339.                      w[1] = (float)CharToShort(&chrTemp[8])/32768*2000;
  340.                     w[2] = (float)CharToShort(&chrTemp[10])/32768*2000;
  341.                     h[0] = CharToShort(&chrTemp[12]);
  342.                     h[1] = CharToShort(&chrTemp[14]);
  343.                     h[2] = CharToShort(&chrTemp[16]);               
  344.                     Angle[0] = (float)CharToShort(&chrTemp[18])/32768*180;
  345.                     Angle[1] = (float)CharToShort(&chrTemp[20])/32768*180;
  346.                     Angle[2] = (float)CharToShort(&chrTemp[22])/32768*180;*/              
  347.         }
  348. }


复制代码


回复

使用道具 举报

ID:123289 发表于 2017-9-11 18:48 | 显示全部楼层
一定是你自己不会写程序
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表