GY-25傾斜度角度模塊串口直接輸出角度數據 MPU-6050模塊傳感器

ID:124148 · 發表于 2016-5-31 01:25

給大家點好東西，這個資料挺不錯的，GY-25傾斜度角度模塊串口直接輸出角度數據 MPU-6050模塊傳感器.rar 就和大家分享下

51單片機程序：

// GY-25
// 使用單片機：STC89C52
// 晶振： 11.0592 M
// 液晶屏：LCD1602
// 波特率：9600
#include<REG52.H>
#include<math.h> //Keil library
#include<stdio.h> //Keil library
#include<INTRINS.H>
#define uchar unsigned char
#define uint unsigned int
//********定義變量*****************************
uchar BUF[10]; //數據緩存區
uchar cnt=0; //接收數據的累計值
uchar sign=0;
int YPR[3];
//********定義函數*****************************
void delay(unsigned int k);
void SeriPushSend(uchar send_data);
void display(void);
//*********************************************
//串口中斷
void serial_serve(void) interrupt 4
{
if(RI==1){ //中斷標志
RI=0;
BUF[cnt]=SBUF;
cnt++; //接收計數
if(cnt==8) //
{
cnt=0; //
sign=1;
}
}
}
//*********************************************
//串口初始化
//9600 bps @ 11.059 MHz
void init_uart()
{
TMOD=0x21;
TH1=0xfd;
TL1=0xfd;
SCON=0x50;
PS=1; //串口中斷設為高優先級別
TR0=1; //啟動定時器
TR1=1;
ET0=1; //打開定時器0中斷
ES=1;
}
//**********延時函數***************
void delay(unsigned int k)
{
unsigned int i,j;
for(i=0;i<k;i++)
{
for(j=0;j<121;j++)
{;}
}
}
//*********串口數據發送******************
void SeriPushSend(uchar send_data)
{
SBUF=send_data;
while(!TI);TI=0;
}
//*************************************
void dis_play(int num)
{
if(num<0)
{
num=-num;
SeriPushSend('-');
}
else
SeriPushSend('+');
SeriPushSend(0x30|(num/10000));
SeriPushSend(0x30|(num%10000/1000));
SeriPushSend(0x30|(num%1000/100));
SeriPushSend(0x2e);
SeriPushSend(0x30|(num%100/10));
SeriPushSend(0x30|(num%10));
SeriPushSend(',');
}
//*******************數據接收并顯示**********************
void display(void)
{
if(sign){
sign=0;
if(BUF[0]==0XAA&&BUF[7]==0X55){ //幀頭判斷
YPR[0]=(BUF[1]<<8|BUF[2]);
YPR[1]=(BUF[3]<<8|BUF[4]);
YPR[2]=(BUF[5]<<8|BUF[6]);
SeriPushSend('#');
SeriPushSend('Y');
SeriPushSend('P');
SeriPushSend('R');
SeriPushSend('=');
dis_play(YPR[0]);
dis_play(YPR[1]);
dis_play(YPR[2]);
SeriPushSend(0X0d);
SeriPushSend(0X0a);
}
}
}
//***************************************
//主程序
void main()
{
delay(2000); //延時
init_uart(); //初始化串口
EA=1; //開總中斷
cnt=0;
SeriPushSend(0XA5);
SeriPushSend(0X52); //發送1幀讀取命令，連續讀取
while(1){
display();
} //end while
}

復制代碼

arduino程序：

//GY-25 ARDUINO 測試代碼 IICLCD2004顯示角度
//注意1：下載程序時候，請先斷開GY25的連線!否則將導致下載不成功
//注意2：GY25模塊使用時，上電自校正,建議不要用手拿著模塊,
// 保持3秒以上靜止狀態，才能發送命令開始工作
// GY25 arduino pro mini
// VCC----------------------VCC
// RX-----------------------TX
// TX-----------------------RX
// GND----------------------GND
//-----------------------------------------------
// IICLCD2004 arduino pro mini
// VCC----------------------VCC
// SCL----------------------A5
// SDA----------------------A4
// GND----------------------GND
#include <Wire.h>
#include <LiquidCrystal_I2C.h>
int YPR[3];
unsigned char Re_buf[8],counter=0;
unsigned char sign=0;
int led = 13;
LiquidCrystal_I2C lcd(0x20,20,4); // set the LCD address to 0x20 for a 20 chars and 4 line display
//-----------------------------------------------------------
void setup()
{
lcd.init(); // initialize the lcd
// Print a message to the LCD.
Serial.begin(115200);
delay(2000);
Serial.write(0XA5);
Serial.write(0X52); //初始化GY25,連續輸出模式
lcd.backlight();
lcd.setCursor(0,0); //I2C接口LCD2004顯示初始值
lcd.print("Yaw:");
lcd.setCursor(0,1);
lcd.print("Pitch:");
lcd.setCursor(0,2);
lcd.print("Roll:");
}
//-------------------------------------------------------------
void loop() {
if(sign)
{
sign=0;
if(Re_buf[0]==0xAA && Re_buf[7]==0x55) //檢查幀頭，幀尾
{
YPR[0]=(Re_buf[1]<<8|Re_buf[2])/100; //合成數據，去掉小數點后2位
YPR[1]=(Re_buf[3]<<8|Re_buf[4])/100;
YPR[2]=(Re_buf[5]<<8|Re_buf[6])/100;
lcd.setCursor(4,0);
lcd.print(" ");
lcd.setCursor(4,0);
lcd.print(YPR[0]); //顯示航向
lcd.setCursor(6,1);
lcd.print(" ");
lcd.setCursor(6,1); //顯示俯仰角
lcd.print(YPR[1]);
lcd.setCursor(5,2);
lcd.print(" ");
lcd.setCursor(5,2); //顯示橫滾角
lcd.print(YPR[2]);
delay(100);
}
}
}
//---------------------------------------------------------------
void serialEvent() {
while (Serial.available()) {
Re_buf[counter]=(unsigned char)Serial.read();
if(counter==0&&Re_buf[0]!=0xAA) return; // 檢查幀頭
counter++;
if(counter==8) //接收到數據
{
counter=0; //重新賦值，準備下一幀數據的接收
sign=1;
}
}
}

復制代碼

ID:192644 · 發表于 2017-4-23 19:25

如果沒有led,我用電腦串口數據應該怎么辦呀
這個程序哪里讀的數據呀，不是只有傳輸嗎？
新手，大神幫忙

ID:225586 · 發表于 2017-8-24 13:32

厲害aa

ID:246080 · 發表于 2017-11-4 20:24

正好我需要這個

ID:289615 · 發表于 2018-3-9 12:32

好厲害的樣子啊

ID:521996 · 發表于 2019-5-26 16:54

正好需要，下載來看看！

ID:421308 · 發表于 2019-7-17 15:10

正好需要，進來看看

ID:586056 · 發表于 2019-7-17 23:32

謝謝了，

ID:594119 · 發表于 2019-8-5 19:55

挺不錯的資料

ID:518004 · 發表于 2019-10-21 20:16

xiaozhong1314 發表于 2019-7-17 15:10
正好需要，進來看看

您好，請問你們利用這個程序成功實現了么？我是新手，想請教請教一下在實驗中I2C數據和時鐘口應該怎么接呢？

ID:628217 · 發表于 2019-10-23 09:26

先保存下來，以后能用得上

帳號		自動登錄	找回密碼
密碼			立即注冊

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

GY-25傾斜度角度模塊串口直接輸出角度數據 MPU-6050模塊傳感器

評分

相關帖子

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

GY-25傾斜度角度模塊 串口直接輸出角度數據 MPU-6050模塊 傳感器

評分

相關帖子

GY-25傾斜度角度模塊串口直接輸出角度數據 MPU-6050模塊傳感器