附上一些主要代码
主函数
void main (void)
{
Dly_ms(500);//延时以使得6050上电
MPU6050_Init();//初始化6050
all_init();
while(1)
{
display1();
button();
//judge();
//motor_control();
test();
}
}
//*************************************//
int16 accel_x,accel_y,accel_z,gyro_x,gyro_y,gyro_z;
float32 temperature;
void test(void)
{
accel_x = MPU6050_GetResult(ACCEL_XOUT_H);
accel_y = MPU6050_GetResult(ACCEL_YOUT_H);
accel_z = MPU6050_GetResult(ACCEL_ZOUT_H);
gyro_x = MPU6050_GetResult(GYRO_XOUT_H);
gyro_y = MPU6050_GetResult(GYRO_YOUT_H);
gyro_z = MPU6050_GetResult(GYRO_ZOUT_H);
temperature = MPU6050_GetResult(TEMP_OUT_H)/340+36.53;
}
|