|
|
1 簡述
想做一個(gè)能觀察我的VGA小車的姿態(tài)角度的系統(tǒng)，一直在網(wǎng)上找相對(duì)應(yīng)的模塊。想找個(gè)性價(jià)比高點(diǎn)的，同時(shí)精度高點(diǎn)的。最后在淘寶上找到一款JY901模塊。這個(gè)模塊能XY動(dòng)態(tài)精度0.1度，靜態(tài)能到0.05度。Z軸的精度為1度。一般一百多元的價(jià)格，能到這個(gè)精度的還是很少的。果斷入手一個(gè)來測(cè)試下性能。下圖給大家看下這個(gè)模塊
模塊的體積很小，很方便能貼在我的PCB板上。不過這個(gè)模塊的Z軸不能受磁場(chǎng)干擾。因此只能遠(yuǎn)離我的VGA小車的電機(jī)，我把這個(gè)模塊和我的板子一起用桿子撐起來，遠(yuǎn)離這些干擾（我是做的一根30CM的桿）。最后測(cè)試效果還可以的。
2 連接方式
這個(gè)JY901連接是很方便的。供電3.3-5v。直接接我單片機(jī)上電壓就行了。接線的方式如下：
3 串口讀取程序
串口讀取簡單分為兩個(gè)部分。1、配置單片機(jī)的UART口。2、數(shù)據(jù)處理部分了。下面和大家一一分享。
3.1配置單片機(jī)的UART口
我使用的是UART2，使用時(shí)鐘、模式、速度等。都在下面大家參考下
void Initial_UART2(unsigned long baudrate)
{
GPIO_InitTypeDef GPIO_InitStructure;
USART_InitTypeDef USART_InitStructure;
NVIC_InitTypeDef NVIC_InitStructure;
RCC_APB1PeriphClockCmd(RCC_APB1Periph_USART2 | RCC_APB2Periph_GPIOA, ENABLE);
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_2;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_Init(GPIOA, &GPIO_InitStructure);
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_3;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;
GPIO_Init(GPIOA, &GPIO_InitStructure);
USART_InitStructure.USART_BaudRate = baudrate;
USART_InitStructure.USART_WordLength = USART_WordLength_8b;
USART_InitStructure.USART_StopBits = USART_StopBits_1;
USART_InitStructure.USART_Parity = USART_Parity_No ;
USART_InitStructure.USART_HardwareFlowControl = USART_HardwareFlowControl_None;
USART_InitStructure.USART_Mode = USART_Mode_Rx | USART_Mode_Tx;
USART_Init(USART2, &USART_InitStructure);
USART_ITConfig(USART2, USART_IT_TXE, DISABLE);
USART_ITConfig(USART2, USART_IT_RXNE, ENABLE);
USART_ClearFlag(USART2,USART_FLAG_TC);
USART_Cmd(USART2, ENABLE);
NVIC_InitStructure.NVIC_IRQChannel = USART2_IRQn;
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1;
NVIC_InitStructure.NVIC_IRQChannelSubPriority = 8;
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
NVIC_Init(&NVIC_InitStructure);
}
3.2 數(shù)據(jù)處理
3.2.1數(shù)據(jù)接收
編寫思維是這樣的。當(dāng)我的UART2接受到數(shù)據(jù)后就會(huì)存在我的ucRxBuffer[250]里，根據(jù)這個(gè)JY901的通訊協(xié)議。我就開始判斷我接受的數(shù)據(jù)里面是不是有55包頭的數(shù)據(jù)。然后我還加了一個(gè)計(jì)數(shù)ucRxCnt。加在一起我會(huì)判斷。整個(gè)數(shù)據(jù)的長度是不是11位數(shù)據(jù)。最后，根據(jù)商家給的通訊協(xié)議里。50代表時(shí)間、51加速度、52角速度、53角度、54磁場(chǎng)等，我再判斷我的這11位數(shù)據(jù)的第二位是上面的哪個(gè)值。就可以了。
void CopeSerial2Data(unsigned char ucData)
{
static unsigned char ucRxBuffer[250];
static unsigned char ucRxCnt = 0;
LED_REVERSE();
ucRxBuffer[ucRxCnt++]=ucData;
if (ucRxBuffer[0]!=0x55
{
ucRxCnt=0;
return;
}
if (ucRxCnt<11) {return;
else
{
switch(ucRxBuffer[1])
{
case 0x50: memcpy(&stcTime,&ucRxBuffer[2],8);break
case 0x51: memcpy(&stcAcc,&ucRxBuffer[2],8);break;
case 0x52: memcpy(&stcGyro,&ucRxBuffer[2],8);break;
case 0x53: memcpy(&stcAngle,&ucRxBuffer[2],8);break;
case 0x54: memcpy(&stcMag,&ucRxBuffer[2],8);break;
case 0x55: memcpy(&stcDStatus,&ucRxBuffer[2],8);break;
case 0x56: memcpy(&stcPress,&ucRxBuffer[2],8);break;
case 0x57: memcpy(&stcLonLat,&ucRxBuffer[2],8);break;
case 0x58: memcpy(&stcGPSV,&ucRxBuffer[2],8);break;
case 0x59: memcpy(&stcQ,&ucRxBuffer[2],8);break;
}
ucRxCnt=0
}
}
3.2.2 數(shù)據(jù)解算
解算這塊呢，最關(guān)鍵的是就是根據(jù)商家給的公式去解算。我上面獲取的16進(jìn)制的數(shù)據(jù)。按照公式套進(jìn)去就可以了。 printf("Time:20%d-%d-%d %d:%d:%.3f\r\n",stcTime.ucYear,stcTime.ucMonth,stcTime.ucDay,stcTime.ucHour,stcTime.ucMinute,(float)stcTime.ucSecond+(float)stcTime.usMiliSecond/1000); delay_ms(10);
printf("Acc:%.3f %.3f %.3f\r\n",(float)stcAcc.a[0]/32768*16,(float)stcAcc.a[1]/32768*16,(float)stcAcc.a[2]/32768*16);
delay_ms(10);
printf("Gyro:%.3f %.3f %.3f\r\n",(float)stcGyro.w[0]/32768*2000,(float)stcGyro.w[1]/32768*2000,(float)stcGyro.w[2]/32768*2000);
delay_ms(10);
printf("Angle:%.3f %.3f %.3f\r\n",(float)stcAngle.Angle[0]/32768*180,(float)stcAngle.Angle[1]/32768*180, (float)stcAngle.Angle[2]/32768*180);
delay_ms(10);
printf("Mag:%d %d %d\r\n",stcMag.h[0],stcMag.h[1],stcMag.h[2]);
delay_ms(10);
printf("Pressure:%ld Height%.2f\r\n",stcPress.lPressure,(float)stcPress.lAltitude/100);
delay_ms(10);
printf("DStatus:%d %d %d %d\r\n",stcDStatus.sDStatus[0],stcDStatus.sDStatus[1],stcDStatus.sDStatus[2],stcDStatus.sDStatus[3]);
delay_ms(10);
printf("Longitude:%ldDeg%.5fm Lattitude:%ldDeg%.5fm\r\n",stcLonLat.lLon/10000000,(double)(stcLonLat.lLon % 10000000)/1e5,stcLonLat.lLat/10000000,(double)(stcLonLat.lLat % 10000000)/1e5);
delay_ms(10);
printf("GPSHeight:%.1fm GPSYaw:%.1fDeg GPSV:%.3fkm/h\r\n",(float)stcGPSV.sGPSHeight/10,(float)stcGPSV.sGPSYaw/10,(float)stcGPSV.lGPSVelocity/1000);
delay_ms(10);
printf("Four elements:%.5f %.5f %.5f %.5f\r\n\r\n",(float)stcQ.q[0]/32768,(float)stcQ.q[1]/32768,(float)stcQ.q[2]/32768,(float)stcQ.q[3]/32768);
delay_ms(10);
最后給大家分享下我寫的這個(gè)代碼
STM32Core串口JY901接串口助手.7z
(669.13 KB, 下載次數(shù): 30)
2020-6-16 22:36 上傳
點(diǎn)擊文件名下載附件
下載積分: 黑幣 -5
https://pan.baidu.com/s/1Wp3A4_84FjCUURahqlVK6A
|
評(píng)分
-
查看全部評(píng)分
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
