OpenEdv-开源电子网

 找回密码
 立即注册
正点原子全套STM32/Linux/FPGA开发资料,上千讲STM32视频教程免费下载...
查看: 3422|回复: 1

关于mini板的mpu6050 z轴角度输出的问题

[复制链接]

4

主题

6

帖子

0

精华

新手上路

积分
46
金钱
46
注册时间
2016-8-17
在线时间
6 小时
发表于 2016-9-3 21:27:38 | 显示全部楼层 |阅读模式
1金钱
/**
  ******************************************************************************
  * @file    main.c
  * @author  LYC
  * @version V1.0
  * @date    2014-04-22
  * @brief   移植野火的软件I2C
  ******************************************************************************
  * @attention
  * 实验平台:野火 iSO STM32 开发板
  ******************************************************************************
  */
  
#include "stm32f10x.h"
#include "stm32f10x_it.h"
#include "bsp_SysTick.h"
#include "bsp_led.h"
#include "bsp_usart1.h"
#include "mpu6050.h"
#include "bsp_i2c.h"
#include "math.h"
#define TASK_ENABLE 0
extern unsigned int Task_Delay[NumOfTask];
/*
* t : 定时时间
* Ticks : 多少个时钟周期产生一次中断
* f : 时钟频率 72000000
* t = Ticks * 1/f = (72000000/100000) * (1/72000000) = 10us
*/
/**
  * @brief  主函数
  * @param  无  
  * @retval 无
  */
int main(void)
{
short Accel[3];
short Gyro[3];
short Temp;
  
  //初始化systick
SysTick_Init();
SysTick->CTRL|=SysTick_CTRL_ENABLE_Msk;
/* LED 端口初始化 */
LED_GPIO_Config();
/* 串口通信初始化 */
USART1_Config();
NVIC_Configuration();
//I2C初始化
i2c_GPIO_Config();
  //MPU6050初始化
MPU6050_Init();
while(1)
{
  u8 anglez,Ax,Ay,Az;
  if(Task_Delay[0]==TASK_ENABLE)
  {
   LED1_TOGGLE;
   Task_Delay[0]=1000;
  }
  
  if(Task_Delay[1]==0)
  {
   MPU6050ReadAcc(Accel);
   if(Accel[0]<32764)
{
  Ax=Accel[0]/16384;
}
else
{
  Ax=1-(Accel[0]-49152)/16384;
}
if(Accel[2]<32764)
{
  Az=Accel[2]/16384;
}
else
{
  Az=(Accel[2]-49152)/16384;
}
anglez=(atan(Ax/Az))*180/3.14;
printf("\r\nz轴角度 %8d   ",anglez);    //z轴

   Task_Delay[1]=1000;//此值每1ms会减1,减到0才可以重新进来这里,所以执行的周期是100ms
  }

正点原子逻辑分析仪DL16劲爆上市
回复

使用道具 举报

530

主题

11万

帖子

34

精华

管理员

Rank: 12Rank: 12Rank: 12

积分
165524
金钱
165524
注册时间
2010-12-1
在线时间
2116 小时
发表于 2016-9-3 22:08:01 | 显示全部楼层
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则



关闭

原子哥极力推荐上一条 /2 下一条

正点原子公众号

QQ|手机版|OpenEdv-开源电子网 ( 粤ICP备12000418号-1 )

GMT+8, 2025-5-25 23:30

Powered by OpenEdv-开源电子网

© 2001-2030 OpenEdv-开源电子网

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