【UGV】Arduino Mega2560 获取小车角度信息,传感器JY60
生活随笔
收集整理的這篇文章主要介紹了
【UGV】Arduino Mega2560 获取小车角度信息,传感器JY60
小編覺得挺不錯(cuò)的,現(xiàn)在分享給大家,幫大家做個(gè)參考.
詳細(xì)版原理圖請(qǐng)參考:【UGV】小車一些圖片 麥輪版小車
示例程序如下:
使用的是 Mega2560 的 3 號(hào)串口讀取了 JY60 角度傳感器傳回來(lái)的的角度信息,然后通過(guò) 1 號(hào)串口在電腦上進(jìn)行了顯示。
#include <Wire.h> #include <JY901.h> /* http://item.taobao.com/item.htm?id=43511899945 Test on mega2560. JY901 mega2560 TX <---> 0(Rx) */ void setup() {Serial.begin(115200); Serial3.begin(9600); // 注意這里通信波特率不能改 }void loop() {//print received data. Data was received in serialEvent; // Serial.print("Time:20");Serial.print(JY901.stcTime.ucYear);Serial.print("-");Serial.print(JY901.stcTime.ucMonth);Serial.print("-");Serial.print(JY901.stcTime.ucDay); // Serial.print(" ");Serial.print(JY901.stcTime.ucHour);Serial.print(":");Serial.print(JY901.stcTime.ucMinute);Serial.print(":");Serial.println((float)JY901.stcTime.ucSecond+(float)JY901.stcTime.usMiliSecond/1000); // // Serial.print("Acc:");Serial.print((float)JY901.stcAcc.a[0]/32768*16);Serial.print(" ");Serial.print((float)JY901.stcAcc.a[1]/32768*16);Serial.print(" ");Serial.println((float)JY901.stcAcc.a[2]/32768*16); // // Serial.print("Gyro:");Serial.print((float)JY901.stcGyro.w[0]/32768*2000);Serial.print(" ");Serial.print((float)JY901.stcGyro.w[1]/32768*2000);Serial.print(" ");Serial.println((float)JY901.stcGyro.w[2]/32768*2000);Serial.print("Angle:");Serial.print((float)JY901.stcAngle.Angle[0]/32768*180);Serial.print(" ");Serial.print((float)JY901.stcAngle.Angle[1]/32768*180);Serial.print(" ");Serial.println((float)JY901.stcAngle.Angle[2]/32768*180); // // Serial.print("Mag:");Serial.print(JY901.stcMag.h[0]);Serial.print(" ");Serial.print(JY901.stcMag.h[1]);Serial.print(" ");Serial.println(JY901.stcMag.h[2]); // // Serial.print("Pressure:");Serial.print(JY901.stcPress.lPressure);Serial.print(" ");Serial.println((float)JY901.stcPress.lAltitude/100); // // Serial.print("DStatus:");Serial.print(JY901.stcDStatus.sDStatus[0]);Serial.print(" ");Serial.print(JY901.stcDStatus.sDStatus[1]);Serial.print(" ");Serial.print(JY901.stcDStatus.sDStatus[2]);Serial.print(" ");Serial.println(JY901.stcDStatus.sDStatus[3]); // // Serial.print("Longitude:");Serial.print(JY901.stcLonLat.lLon/10000000);Serial.print("Deg");Serial.print((double)(JY901.stcLonLat.lLon % 10000000)/1e5);Serial.print("m Lattitude:"); // Serial.print(JY901.stcLonLat.lLat/10000000);Serial.print("Deg");Serial.print((double)(JY901.stcLonLat.lLat % 10000000)/1e5);Serial.println("m"); // // Serial.print("GPSHeight:");Serial.print((float)JY901.stcGPSV.sGPSHeight/10);Serial.print("m GPSYaw:");Serial.print((float)JY901.stcGPSV.sGPSYaw/10);Serial.print("Deg GPSV:");Serial.print((float)JY901.stcGPSV.lGPSVelocity/1000);Serial.println("km/h"); // Serial.println("");delay(500);while (Serial3.available()) {JY901.CopeSerialData(Serial3.read()); //Call JY901 data cope function}}總結(jié)
以上是生活随笔為你收集整理的【UGV】Arduino Mega2560 获取小车角度信息,传感器JY60的全部?jī)?nèi)容,希望文章能夠幫你解決所遇到的問(wèn)題。
- 上一篇: 【UGV】小车一些图片 麦轮版小车
- 下一篇: 【UGV】Mec 麦轮版小车驱动程序示例