寡妇高潮一级毛片最简单处理,亚洲国内精品久久久,中文无码亚洲精品制服丝袜

// 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]; //數(shù)據(jù)緩存區(qū)
uchar cnt=0; //接收數(shù)據(jù)的累計值
uchar sign=0;
int YPR[3];
//********定義函數(shù)*****************************
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++; //接收計數(shù)
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; //串口中斷設(shè)為高優(yōu)先級別
TR0=1; //啟動定時器
TR1=1;
ET0=1; //打開定時器0中斷
ES=1;
}
//**********延時函數(shù)***************
void delay(unsigned int k)
{
unsigned int i,j;
for(i=0;i<k;i++)
{
for(j=0;j<121;j++)
{;}
}
}
//*********串口數(shù)據(jù)發(fā)送******************
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(',');
}
//*******************數(shù)據(jù)接收并顯示**********************
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); //發(fā)送1幀讀取命令，連續(xù)讀取
while(1){
display();
} //end while
}

復制代碼

//GY-25 ARDUINO 測試代碼 IICLCD2004顯示角度
//注意1：下載程序時候，請先斷開GY25的連線!否則將導致下載不成功
//注意2：GY25模塊使用時，上電自校正,建議不要用手拿著模塊,
// 保持3秒以上靜止狀態(tài)，才能發(fā)送命令開始工作
// 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,連續(xù)輸出模式
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; //合成數(shù)據(jù)，去掉小數(shù)點后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) //接收到數(shù)據(jù)
{
counter=0; //重新賦值，準備下一幀數(shù)據(jù)的接收
sign=1;
}
}
}

復制代碼