日本黄色一级经典视频|伊人久久精品视频|亚洲黄色色周成人视频九九九|av免费网址黄色小短片|黄色Av无码亚洲成年人|亚洲1区2区3区无码|真人黄片免费观看|无码一级小说欧美日免费三级|日韩中文字幕91在线看|精品久久久无码中文字幕边打电话

當(dāng)前位置:首頁(yè) > > 充電吧
[導(dǎo)讀]之前使用的是ADXL362測(cè)量加速度,功耗特別低,使用的還可以,但是后來(lái)用于測(cè)量角度時(shí)誤差特別大,最終更換為MMA8452Q ,這個(gè)芯片較便宜,測(cè)量設(shè)備靜態(tài)的傾角,還是蠻好用的,我的使用中只需要測(cè)量Z

之前使用的是ADXL362測(cè)量加速度,功耗特別低,使用的還可以,但是后來(lái)用于測(cè)量角度時(shí)誤差特別大,最終更換為MMA8452Q ,這個(gè)芯片較便宜,測(cè)量設(shè)備靜態(tài)的傾角,還是蠻好用的,我的使用中只需要測(cè)量Z軸的傾角。

/*************************************************************************************************************
?*?文件名:			MMA8452Q.c
?*?功能:			MMA8452Q驅(qū)動(dòng)
?*?作者:			cp1300@139.com
?*?創(chuàng)建時(shí)間:		2018-04-09
?*?最后修改時(shí)間:	2018-04-09
?*?詳細(xì):			MMA8452Q三軸加速度傳感器
					依賴SoftwareIIC
*************************************************************************************************************/
#include?"system.h"
#include?"MMA8452Q.h"
#include?"math.h"
#include#include?"SoftwareIIC.h"

//調(diào)試宏開(kāi)關(guān)
#define?MMA8452Q_DBUG	1
#if?MMA8452Q_DBUG
	#include?"system.h"
	#define?MMA8452Q_Debug(format,...)	uart_printf(format,##__VA_ARGS__)
#else
	#define?MMA8452Q_Debug(format,...)	/
/
#endif	//MMA8452Q_DBUG


#define?PI?3.1415926535898

u8?MMA8452Q_ReadOneReg(MMA8452Q_HANDLE?*pHandle,u8?RegAddr);								//MMA8452Q讀取一個(gè)寄存器
void?MMA8452Q_ReadMultReg(MMA8452Q_HANDLE?*pHandle,u8?RegAddr,?u8?RegNum,?u8?DataBuff[]);	//MMA8452Q讀取多個(gè)寄存器
void?MMA8452Q_WriteOneReg(MMA8452Q_HANDLE?*pHandle,u8?RegAddr,u8?data);						//MMA8452Q寫(xiě)一個(gè)寄存器


/*************************************************************************************************************************
*函數(shù)????????	:	bool?MMA8452Q_Init(MMA8452Q_HANDLE?*pHandle,?u8?SlaveAddr)
*功能????????	:	MMA8452Q初始化
*參數(shù)????????	:	pHandle:句柄;SlaveAddr:芯片IIC地址
*返回????????	:	TRUE:初始化成功;FALSE:初始化失敗
*依賴			:?	底層宏定義
*作者???????	:	cp1300@139.com
*時(shí)間?????		:	2018-04-09
*最后修改時(shí)間	:	2018-04-09
*說(shuō)明????????	:	
*************************************************************************************************************************/
bool?MMA8452Q_Init(MMA8452Q_HANDLE?*pHandle,?u8?SlaveAddr)
{
	u8?temp;
	
	if(pHandle?==?NULL)?return?FALSE;
	pHandle->SlaveAddr?=?SlaveAddr;
	
	
	MMA8452Q_WriteOneReg(pHandle,?0x2A,?0x01);
	MMA8452Q_WriteOneReg(pHandle,?0x2B,?0x02);
	temp?=?MMA8452Q_ReadOneReg(pHandle,?0x0D);	//讀取器件ID
	if(temp?!=?0x2A)	//ID不對(duì)
	{
		uart_printf("初始化失敗,ID錯(cuò)誤:0x%02Xrn",?temp);
		return?FALSE;
	}
	uart_printf("ID:0x%02Xrn",?temp);
	
	return?TRUE;
}


/*************************************************************************************************************************
*函數(shù)????????	:	u8?MMA8452Q_ReadOneReg(MMA8452Q_HANDLE?*pHandle,u8?RegAddr)
*功能????????	:	MMA8452Q讀取一個(gè)寄存器
*參數(shù)????????	:	pHandle:句柄;RegAddr:寄存器地址
*返回????????	:	讀取的寄存器值
*依賴			:?	底層宏定義
*作者???????	:	cp1300@139.com
*時(shí)間?????		:	2018-04-09
*最后修改時(shí)間	:	2018-04-09
*說(shuō)明????????	:	
*************************************************************************************************************************/
u8?MMA8452Q_ReadOneReg(MMA8452Q_HANDLE?*pHandle,u8?RegAddr)
{
	u8?data;
	
	SIIC_Start(&pHandle->IIC_Handle);								//產(chǎn)生IIC起始信號(hào)
	if(SIIC_SendByte(&pHandle->IIC_Handle,?pHandle->SlaveAddr)?==?FALSE)	//發(fā)送設(shè)備地址+寫(xiě)信號(hào)
	{
		DEBUG("沒(méi)有收到ACKrn");
	}
	SIIC_SendByte(&pHandle->IIC_Handle,?RegAddr);					//發(fā)送寄存器地址
	SIIC_Start(&pHandle->IIC_Handle);								//產(chǎn)生IIC起始信號(hào)
	SIIC_SendByte(&pHandle->IIC_Handle,?pHandle->SlaveAddr|BIT0);	//發(fā)送設(shè)備地址+讀信號(hào)
	data?=?SIIC_ReadByte(&pHandle->IIC_Handle,?TRUE);				//SIIC讀取一個(gè)字節(jié)
	SIIC_Stop(&pHandle->IIC_Handle);								//產(chǎn)生IIC停止信號(hào)
	
	return?data;
}


/*************************************************************************************************************************
*函數(shù)????????	:	void?MMA8452Q_ReadMultReg(MMA8452Q_HANDLE?*pHandle,u8?RegAddr,?u8?RegNum,?u8?DataBuff[])
*功能????????	:	MMA8452Q讀取多個(gè)寄存器
*參數(shù)????????	:	pHandle:句柄;RegAddr:寄存器地址;RegNum:寄存器數(shù)量;DataBuff:返回結(jié)果緩沖區(qū)
*返回????????	:	無(wú)
*依賴			:?	底層宏定義
*作者???????	:	cp1300@139.com
*時(shí)間?????		:	2018-04-09
*最后修改時(shí)間	:	2018-04-09
*說(shuō)明????????	:	
*************************************************************************************************************************/
void?MMA8452Q_ReadMultReg(MMA8452Q_HANDLE?*pHandle,u8?RegAddr,?u8?RegNum,?u8?DataBuff[])
{
	u8?i;
	
	SIIC_Start(&pHandle->IIC_Handle);									//產(chǎn)生IIC起始信號(hào)
	SIIC_SendByte(&pHandle->IIC_Handle,?pHandle->SlaveAddr);			//發(fā)送設(shè)備地址+寫(xiě)信號(hào)
	SIIC_SendByte(&pHandle->IIC_Handle,?RegAddr);						//發(fā)送寄存器地址
	SIIC_Start(&pHandle->IIC_Handle);									//產(chǎn)生IIC起始信號(hào)
	SIIC_SendByte(&pHandle->IIC_Handle,?pHandle->SlaveAddr|BIT0);		//發(fā)送設(shè)備地址+讀信號(hào)
	for(i?=?0;i?<?RegNum;i?++)
	{
		if(i?==?(RegNum-1))	//最后一字節(jié)不響應(yīng)ACK
		{
			DataBuff[i]?=?SIIC_ReadByte(&pHandle->IIC_Handle,?FALSE);	//SIIC讀取一個(gè)字節(jié)-NAK
		}
		else
		{
			DataBuff[i]?=?SIIC_ReadByte(&pHandle->IIC_Handle,?TRUE);	//SIIC讀取一個(gè)字節(jié)-ACK
		}	
	}
	SIIC_Stop(&pHandle->IIC_Handle);									//產(chǎn)生IIC停止信號(hào)
}


/*************************************************************************************************************************
*函數(shù)????????	:	void?MMA8452Q_WriteOneReg(MMA8452Q_HANDLE?*pHandle,u8?RegAddr,u8?data)
*功能????????	:	MMA8452Q寫(xiě)一個(gè)寄存器
*參數(shù)????????	:	pHandle:句柄;RegAddr:寄存器地址;data:要寫(xiě)入的值
*返回????????	:	無(wú)
*依賴			:?	底層宏定義
*作者???????	:	cp1300@139.com
*時(shí)間?????		:	2018-04-09
*最后修改時(shí)間	:	2018-04-09
*說(shuō)明????????	:	
*************************************************************************************************************************/
void?MMA8452Q_WriteOneReg(MMA8452Q_HANDLE?*pHandle,u8?RegAddr,u8?data)
{
	SIIC_Start(&pHandle->IIC_Handle);								//產(chǎn)生IIC起始信號(hào)
	SIIC_SendByte(&pHandle->IIC_Handle,?pHandle->SlaveAddr);		//發(fā)送設(shè)備地址+寫(xiě)信號(hào)
	SIIC_SendByte(&pHandle->IIC_Handle,?RegAddr);					//發(fā)送寄存器地址
	SIIC_SendByte(&pHandle->IIC_Handle,?data);						//發(fā)送要寫(xiě)入的數(shù)據(jù)
	SIIC_Stop(&pHandle->IIC_Handle);								//產(chǎn)生IIC停止信號(hào)
}




/*************************************************************************************************************************
*函數(shù)????????	:	bool?MMA8452Q_ReadAcceleration(MMA8452Q_HANDLE?*pHandle,?s16?*pXa,s16?*pYa,?s16?*pZa)
*功能????????	:	MMA8452Q?讀取三軸加速度
*參數(shù)????????	:	pHandle:句柄;pXa:返回X軸加速度;pYa:返回Y軸加速度;pZa:返回Z軸加速度
*返回????????	:	TRUE:成功;FALSE:失敗
*依賴			:?	底層宏定義
*作者???????	:	cp1300@139.com
*時(shí)間?????		:	2018-04-09
*最后修改時(shí)間	:	2018-04-09
*說(shuō)明????????	:	
*************************************************************************************************************************/
bool?MMA8452Q_ReadAcceleration(MMA8452Q_HANDLE?*pHandle,?s16?*pXa,s16?*pYa,?s16?*pZa)
{
	u8?buff[6];
	s16?temp;
	
	temp?=?MMA8452Q_ReadOneReg(pHandle,?0x0D);	//讀取器件ID
	if(temp?!=?0x2A)	//ID不對(duì)
	{
		return?FALSE;
	}
	MMA8452Q_ReadMultReg(pHandle,?1,?6,?buff);	//讀取數(shù)據(jù)
	temp?=?buff[0];
	temp<>4;
	if(buff[0]?&?BIT7)	//負(fù)數(shù)
	{
		temp?|=?0xF000;
	}
	*pXa?=?temp;	//X軸
	
	temp?=?buff[2];
	temp<>4;
	if(buff[2]?&?BIT7)	//負(fù)數(shù)
	{
		temp?|=?0xF000;
	}
	*pYa?=?temp;	//Y軸
	
	temp?=?buff[4];
	temp<>4;
	if(buff[4]?&?BIT7)	//負(fù)數(shù)
	{
		temp?|=?0xF000;
	}
	*pZa?=?temp;	//Z軸

	return?TRUE;
}



/*************************************************************************************************************************
*函數(shù)????????	:	void?ADXL362_CalAngle(s16?Xa,s16?Ya,?s16?Za,?float?*pAngleX,?float?*pAngleY,?float?*pAngleZ)
*功能????????	:	ADXL362?通過(guò)加速度計(jì)算角度信息
*參數(shù)????????	:	Xa:X軸加速度;Ya:Y軸加速度;Za:Z軸加速度,pAngleX:X方向傾角;pAngleY:Y方向傾角;pAngleZ:Z方向傾角
*返回????????	:	無(wú)
*依賴			:?	底層宏定義
*作者???????	:	cp1300@139.com
*時(shí)間?????		:	2016-04-06
*最后修改時(shí)間	:	2018-03-13
*說(shuō)明????????	:	需要進(jìn)行浮點(diǎn),反正切運(yùn)算
*************************************************************************************************************************/
void?MMA8452Q_CalAngle(s16?Xa,s16?Ya,?s16?Za,?float?*pAngleX,?float?*pAngleY,?float?*pAngleZ)
{
	double?A;
	
	//X方向
	A?=?(double)Ya*Ya+(double)Za*Za;
	A?=?sqrt(A);
	A?=?(double)Xa/A;
	A?=?atan(A);?
	A?=?A*180/PI;
	if(Za<0)	//將坐標(biāo)轉(zhuǎn)換為±180度
	{
		if(A?<0)A=-90-(A+90);
		else?A=90+(90-A);
	}
	if(A?<0)	//將坐標(biāo)轉(zhuǎn)換為360度
	{
		A=fabs(A);
		A?=?180+180-A;
	}
	*pAngleX?=?A;	
	
	//Y方向
	A?=?(double)Xa*Xa+(double)Za*Za;
	A?=?sqrt(A);
	A?=?(double)Ya/A;
	A?=?atan(A);?
	A?=?A*180/PI;
	if(Za<0)//將坐標(biāo)轉(zhuǎn)換為±180度
	{
		if(A?<0)A=-90-(A+90);
		else?A=90+(90-A);
	}
	if(A?<0)	//將坐標(biāo)轉(zhuǎn)換為360度
	{
		A=fabs(A);
		A?=?180+180-A;
	}
	*pAngleY?=?A;
	
	//Z方向
	A?=?(double)Xa*Xa+(double)Ya*Ya;
	A?=?sqrt(A);
	A?=?(double)A/abs(Za);
	A?=?atan(A);?
	A?=?A*180/PI;
	uart_printf("XA:%dtYA:%dtZA:%dt",Xa,Ya,Za);
	/*if(Za<0)//將坐標(biāo)轉(zhuǎn)換為±180度
	{
		if(A?<0)A=-90-(A+90);
		else?A=90+(90-A);
	}
	if(A?<0)	//將坐標(biāo)轉(zhuǎn)換為360度
	{
		A=fabs(A);
		A?=?180+180-A;
	}*/
	*pAngleZ?=?A;
}


/*************************************************************************************************************************
*函數(shù)????????	:	bool?MMA8452Q_GetZAxisAngle(MMA8452Q_HANDLE?*pHandle,s16?AcceBuff[3],?float?*pAngleZ)
*功能????????	:	MMA8452Q?獲取Z軸傾角
*參數(shù)????????	:	pHandle:句柄;AcceBuff:3個(gè)軸的加速度;pAngleZ:Y方向傾角
*返回????????	:	TRUE:成功;FALSE:失敗
*依賴			:?	底層宏定義
*作者???????	:	cp1300@139.com
*時(shí)間?????		:	2018-04-09
*最后修改時(shí)間	:	2018-04-09
*說(shuō)明????????	:	
*************************************************************************************************************************/

bool?MMA8452Q_GetZAxisAngle(MMA8452Q_HANDLE?*pHandle,s16?AcceBuff[3],?float?*pAngleZ)
{
	double?fx,fy,fz;
	double?A;
	s16?Xa,Ya,Za;
	
	
	
	
	
	if(MMA8452Q_ReadAcceleration(pHandle,?&Xa,?&Ya,?&Za)?==?FALSE)?return?FALSE;		//ADXL362?讀取加速度數(shù)據(jù)
	//uart_printf("Xa:%d?tYa:%d?tZa:%d?rn",Xa,Ya,Za);
	AcceBuff[0]?=?Xa;	//x軸加速度
	AcceBuff[1]?=?Ya;	//y軸加速度
	AcceBuff[2]?=?Za;	//z軸加速度
	
	fx?=?Xa;
	fx?*=?10.0/1024;
	fy?=?Ya;
	fy?*=?10.0/1024;
	fz?=?Za;
	fz?*=?10.0/1024;
	
	//uart_printf("fx:%.04ftfy:%.04ftfz:%.04ftrn",fx,fy,fz);
	
	//Z方向
	A?=?fx*fx+fy*fy;
	A?=?sqrt(A);
	A?=?(double)A/fz;
	A?=?atan(A);?
	A?=?A*180/PI;
	
	*pAngleZ?=?A;
	//uart_printf("=======角度:%.04frn",*pAngleZ);
	

	return?TRUE;
}
/*************************************************************************************************************
?*?文件名:			MMA8452Q.c
?*?功能:			MMA8452Q驅(qū)動(dòng)
?*?作者:			cp1300@139.com
?*?創(chuàng)建時(shí)間:		2018-04-09
?*?最后修改時(shí)間:	2018-04-09
?*?詳細(xì):			MMA8452Q三軸加速度傳感器
*************************************************************************************************************/
#ifndef?_MMA8452Q_H_
#define?_MMA8452Q_H_
#include?"system.h"
#include?"SoftwareIIC.h"

//MMA8452Q?句柄
typedef?struct
{
	SIIC_HANDLE?IIC_Handle;
	u8?SlaveAddr;
}MMA8452Q_HANDLE;


bool?MMA8452Q_Init(MMA8452Q_HANDLE?*pHandle,?u8?SlaveAddr);											//MMA8452Q初始化
bool?MMA8452Q_ReadAcceleration(MMA8452Q_HANDLE?*pHandle,?s16?*pXa,s16?*pYa,?s16?*pZa);				//MMA8452Q?讀取三軸加速度
bool?MMA8452Q_GetZAxisAngle(MMA8452Q_HANDLE?*pHandle,s16?AcceBuff[3],?float?*pAngleZ);				//MMA8452Q?獲取Z軸角度信息


#endif?/*_MMA8452Q_H_*/


//測(cè)試

g_SysFlag.ADXL362_Status?=?MMA8452Q_Init(&g_SysFlag.MMA8452Q_Handle,?0x1C<<1);
	if(g_SysFlag.ADXL362_Status?==?FALSE)
	{
		DEBUG("MMA8452Q初始化失?。n");
	}
if(MMA8452Q_GetZAxisAngle(&g_SysFlag.MMA8452Q_Handle,?g_SysFlag.AcceBuff,?&AngleZ)?==?FALSE)			//ADXL362?獲取角度信息
			{
				//角度讀取失敗
				AngleZ?=?0;	//讀取失敗,固定為0
			}



本站聲明: 本文章由作者或相關(guān)機(jī)構(gòu)授權(quán)發(fā)布,目的在于傳遞更多信息,并不代表本站贊同其觀點(diǎn),本站亦不保證或承諾內(nèi)容真實(shí)性等。需要轉(zhuǎn)載請(qǐng)聯(lián)系該專欄作者,如若文章內(nèi)容侵犯您的權(quán)益,請(qǐng)及時(shí)聯(lián)系本站刪除。
換一批
延伸閱讀

在嵌入式開(kāi)發(fā)中,STM32的時(shí)鐘系統(tǒng)因其靈活性和復(fù)雜性成為開(kāi)發(fā)者關(guān)注的焦點(diǎn)。然而,看似簡(jiǎn)單的時(shí)鐘配置背后,隱藏著諸多易被忽視的陷阱,輕則導(dǎo)致系統(tǒng)不穩(wěn)定,重則引發(fā)硬件損壞。本文從時(shí)鐘源選擇、PLL配置、總線時(shí)鐘分配等關(guān)鍵環(huán)...

關(guān)鍵字: STM32 時(shí)鐘系統(tǒng)

在嵌入式系統(tǒng)開(kāi)發(fā)中,STM32系列微控制器的內(nèi)部溫度傳感器因其低成本、高集成度特性,廣泛應(yīng)用于設(shè)備自檢、環(huán)境監(jiān)測(cè)等場(chǎng)景。然而,受芯片工藝差異和電源噪聲影響,其原始數(shù)據(jù)存在±1.5℃的固有誤差。本文從硬件配置、校準(zhǔn)算法、軟...

關(guān)鍵字: STM32 溫度傳感器

在能源效率與智能化需求雙重驅(qū)動(dòng)下,AC-DC轉(zhuǎn)換器的數(shù)字控制技術(shù)正經(jīng)歷從傳統(tǒng)模擬方案向全數(shù)字架構(gòu)的深刻變革。基于STM32微控制器的PFM(脈沖頻率調(diào)制)+PWM(脈沖寬度調(diào)制)混合調(diào)制策略,結(jié)合動(dòng)態(tài)電壓調(diào)整(Dynam...

關(guān)鍵字: AC-DC STM32

當(dāng)前智能家居產(chǎn)品需求不斷增長(zhǎng) ,在這一背景下 ,對(duì)現(xiàn)有澆花裝置缺陷進(jìn)行了改進(jìn) ,設(shè)計(jì)出基于STM32單片機(jī)的全 自動(dòng)家用澆花機(jī)器人。該設(shè)計(jì)主要由機(jī)械結(jié)構(gòu)和控制系統(tǒng)構(gòu)成 ,機(jī)械結(jié)構(gòu)通過(guò)麥克納姆輪底盤(pán)與噴灑裝置的結(jié)合實(shí)現(xiàn)機(jī)器...

關(guān)鍵字: STM32 麥克納姆輪 安全可靠 通過(guò)性強(qiáng)

用c++編程似乎是讓你的Arduino項(xiàng)目起步的障礙嗎?您想要一種更直觀的微控制器編程方式嗎?那你需要了解一下Visuino!這個(gè)圖形化編程平臺(tái)將復(fù)雜電子項(xiàng)目的創(chuàng)建變成了拖動(dòng)和連接塊的簡(jiǎn)單任務(wù)。在本文中,我們將帶您完成使...

關(guān)鍵字: Visuino Arduino ESP32 STM32

基于STM32與LoRa技術(shù)的無(wú)線傳感網(wǎng)絡(luò)憑借其低功耗、廣覆蓋、抗干擾等特性,成為環(huán)境監(jiān)測(cè)、工業(yè)自動(dòng)化等場(chǎng)景的核心解決方案。然而,如何在復(fù)雜電磁環(huán)境中實(shí)現(xiàn)高效休眠調(diào)度與動(dòng)態(tài)信道優(yōu)化,成為提升網(wǎng)絡(luò)能效與可靠性的關(guān)鍵挑戰(zhàn)。本...

關(guān)鍵字: STM32 LoRa

在實(shí)時(shí)控制系統(tǒng)、高速通信協(xié)議處理及高精度數(shù)據(jù)采集等對(duì)時(shí)間敏感的應(yīng)用場(chǎng)景中,中斷響應(yīng)延遲的優(yōu)化直接決定了系統(tǒng)的可靠性與性能上限。STM32系列微控制器憑借其靈活的嵌套向量中斷控制器(NVIC)、多通道直接內(nèi)存訪問(wèn)(DMA)...

關(guān)鍵字: STM32 DMA

數(shù)字電源技術(shù)向高功率密度、高效率與高動(dòng)態(tài)響應(yīng)方向加速演進(jìn),STM32微控制器憑借其基于DSP庫(kù)的算法加速能力與對(duì)LLC諧振變換器的精準(zhǔn)控制架構(gòu),成為優(yōu)化電源動(dòng)態(tài)性能的核心平臺(tái)。相較于傳統(tǒng)模擬控制或通用型數(shù)字控制器,STM...

關(guān)鍵字: STM32 數(shù)字電源

STM32微控制器憑借其針對(duì)電機(jī)控制場(chǎng)景的深度優(yōu)化,成為高精度、高可靠性驅(qū)動(dòng)系統(tǒng)的核心選擇。相較于通用型MCU,STM32在電機(jī)控制領(lǐng)域的核心優(yōu)勢(shì)集中體現(xiàn)在FOC(磁場(chǎng)定向控制)算法的硬件加速引擎與PWM死區(qū)時(shí)間的動(dòng)態(tài)補(bǔ)...

關(guān)鍵字: STM32 電機(jī)控制

無(wú)線充電技術(shù)加速滲透消費(fèi)電子與汽車電子領(lǐng)域,基于Qi協(xié)議的無(wú)線充電發(fā)射端開(kāi)發(fā)成為智能設(shè)備能量補(bǔ)給的核心課題。傳統(tǒng)模擬控制方案存在響應(yīng)滯后、參數(shù)調(diào)整困難等問(wèn)題,而基于STM32的數(shù)字PID控制結(jié)合FOD(Foreign O...

關(guān)鍵字: STM32 無(wú)線充電
關(guān)閉